Part Number Hot Search : 
1N3595 BUJ302AX FDLL300A MSC0943 MS62256 99261 X93255 20501
Product Description
Full Text Search
 

To Download MCX314 Datasheet File

  If you can't view the Datasheet, Please click here to try to view without PDF Reader .  
 
 


  Datasheet File OCR Text:
 Motion Control Card / IC
www..com
MC8041A / MCX314
User's Manual
Ver 2.0
PLENTY ISLAND (TAIWAN) CORPORATION
MC8041A
Contents
1. Introduction . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 0 2. I/O Address Setting and Read / Write Register. . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 1 3. I/O Interfaces . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 2 3.1. Descriptions of ISA BUS Signals . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 2 3.2. Pin Definition of I/O Connector . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 3 3.3. Drive Pulse Signal (nP+P, nP+N, nP-P, nP-N) . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 5 3.4. General Purpose Output Signal (nOUT7 ~ nOUT4) . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 6 3.5. Over Limit Signal (nLMT+, nLMT-) . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 6 3.6. Decelerating / Sudden Stop Input Signal (nIN1, nIN2, nIN3) . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 7 3.7. Input Signal for Servo Driver (nINPOS, nALARM) . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 7 www..com 3.8. Encoder Input Signal (nECAP, nECAN, nECBP, nECBN, nIN0P, nIN0N) . . . . . . . . . . . . . . . . . . . . . . 8 3.9. External Driving Control Input Signal (nEX0P+, nEX0P-) . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 9 3.10 Emergency Stop Input Signal(EMG) . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 10 3.11 External Power Input (VEX) . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 10 4. Interrupt Setting. . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 11 5. Connection Examples for Motor Drivers . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 12 5.2 Connection with Pulse-type Servo Motor Drives . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 13 6. I/O Signal Timing . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 14 6.2 6.3 6.4 6.5 6.6 Individual Driving ............................................................................................... Interpolation Driving . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . Input Pulse Timing . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . Sudden Stop Timing . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . Decelerating Stop Timing . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 14 14 15 16 16
7. Jumper and Switch Layout . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 17 8. Specifications . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 18
1
1. Introduction
MC8041A is a high-speed 4-axis PC-Based motion control card for stepper or pulse-type servo motor drivers. Its features are: . 4-axis independent position / speed control for stepper / pulse-type servo motor drivers . Linear interpolation for any 2 or 3 axes . Circular interpolation for any 2 axes . Bit pattern interpolation for any 2 or 3 axes MC8041A, equipped with our 4-axis motion control IC MCX314, can be directly connect to the ISA bus expansion slot on PCs and their compatible machines. The following is the functional blocks of MC8401A including MCX314, ISA BUS interface and each I/O interface. Please refer MCX314 manual for the functions in details. www..com (X axis I/O interface)
ISA BUS Crystal oscillator 16MHz CLK XP+P/N XP-P/N XOUT7~4 RESETDRV RESETN XLMTP XLMTM XIN3~1 XINPOS XALARM XECA XECB XINPO Photo coupler & RC filter Line driver 26LS31 Output buffer 74LS06 XP+P/N XP-P/N XOUT7~4 Pulse output General output
I/O add. setting switch
VEX External power(DC12~24V) XLMT+ +Limit input XLMT-Limit input XIN3~1 Deceleration input XINPOS Servo motor signal XALARM Servo alarm XECAP/N XECBP/N XINPO/N
AEN SA15~4 IOCS16* SA3~1 IOW* IOR* Address decoder CSN
High-speed photo coupler
Encoder signal input
MCX314
A2~0 WRN RDN XEXOP+ XEXOP-
Photo coupler & RC filter
XEXOP+ XEXOP-
+ Dir. jog -Dir. jog
Y Axis Interface identical to the Input / Output interface of X-axis
SD15~0
Bi-direction buffer
IRQ3 IRQ4 IRQ5 IRQ6 IRQ7 IRQ10 IRQ11 IRQ12 IRQ14 IRQ15
Z Axis Interface identical to the Input / Output interface of X-axis
U Axis Interface identical to the Input / Output interface of X-axis Buffer EMGN Photo coupler & RC filter EMG Emergency stop
Functional Blocks of MC8041A
MCX314
2. I/O Address Setting and Read / Write Register
I/O Address Setting
The I/O port address of MCX314 includes the higher 12 bits, SA15~SA4, of ISA bus I/O address SA15~SA0. This address is set by SW1 and SW2 slide dip switches. The lower 3 bits, SA3~SA1, are used for IC internal read / write register codes. The slide dip switches SW1 and SW2 are with ON and OFF level for SA15 ~ SA4. Switch " ON" to set a binary value 0; switch " OFF" to set a binary value 1 (see the graph below).
SW2
ON ON
SW1 ON : 0 OFF:1 2 3 4 5 6 7 8
www..com
1
2
3
4
1
the setting of I/O address 0280~028Fh This graph shows the initial setting of 0280~028Fh. The user should pay attention not to overlap setting this address with the address of PC main board and / or other I/O cards.
Read / Write Register
The table below lists the I/O mapped read/write registers of MC8041A. All of the registers are accessed by 16bit format. The inside number of ( ) shows the register address when 0280~028Fh of SW1 and SW2 are set. The address setting needs to use word-access, not byte-access. Please refer to Chapter 4 of MCX314 manual for register setting.. I/O Address SA3 SA2 SA1 0 0 0 (0280h) 0 0 1 (0282h) 0 1 (0284h) 0 1 (0286h) 1 0 Write Register Register Name Command Register X axis mode register 1 Y axis mode register 1 Z axis mode register 1 U axis mode register 1 X axis mode register 2 Y axis mode register 2 Z axis mode register 2 U axis mode register 2 BP1P register X axis mode register 3 Y axis mode register 3 Z axis mode register 3 U axis mode register 3 BP1M register Output register BP2P register Interpolation mode register BP2M register Data writing register 1 BP3P register Data writing register 2 BP3M register
1
Symbol WR0 XWR1 Y WR1 Z WR1 U WR1 XWR2 Y WR2 Z WR2 U WR2 BP1P XWR3 Y WR3 Z WR3 U WR3 BP1M WR4 BP2P WR5 BP2M WR6 BP3P WR7 BP3M
Symbol RR0 XRR1 YRR1 ZRR1 URR1 XRR2 YRR2 ZRR2 URR2 XRR3 YRR3 ZRR3 URR3 RR4 RR5 RR6 RR7
Read Register Register Name Main status register X axis status register 1 Y axis status register 1 Z axis status register 1 U axis status register 1 X axis status register 2 Y axis status register 2 Z axis status register 2 U axis status register 2 X axis status register 3 Y axis status register 3 Z axis status register 3 U axis status register 3 Input register 1 Input register 2 Data reading register 1 Data reading register 2
1 0 0 (0288h) 1 0 1 (028Ah) 1 1 0 (028Ch) 1 1 1 (028Eh)
MCX314
3. I/O Interfaces
This chapter describes connector I/O signals. The standard ISA bus is used as the board edge connector. Here, the signal introduction just focuses on the pins used for MX8041A. nOOOO represents any one of X, Y, Z and U axes.
3.1. Descriptions of ISA BUS Signals
Pin Signal Name A1 A2 SD7 A3 SD6 A4 SD5 A5 SD4 A6 SD3 www..com A7 SD2 A8 SD1 A9 SD0 A10 A11 AEN A12 A13 A14 A15 A16 SA15 A17 SA14 A18 SA13 A19 SA12 A20 SA11 A21 SA10 A22 SA9 A23 SA8 A24 SA7 A25 SA6 A26 SA5 A27 SA4 A28 SA3 A29 SA2 A30 SA1 A31 SA0 C1 C2 C3 C4 C5 C6 C7 C8 C9 C10 C11 SD8 C12 SD9 C13 SD10 C14 SD11 C15 SD12 C16 SD13 C17 SD14 C18 SD15 Descriptions Data Data Data Data Data Data Data Data Address Enable I/O I/O I/O I/O I/O I/O I/O I/O I/O Input Pin Signal Name B1 GND B2 RESTDRV B3 + 5V B4 B5 B6 B7 B8 B9 B10 GND B11 B12 B13 IOW B14 IOR B15 B16 B17 B18 B19 B20 B21 IRQ7 B22 IRQ6 B23 IRQ5 B24 IRQ4 B25 IRQ3 B26 B27 B28 B29 + 5V B30 B31 GND D1 D2 IOCS16 D3 IRQ10 D4 IRQ11 D5 IRQ12 D6 IRQ15 D7 IRQ14 D8 D9 D10 D11 D12 D13 D14 D15 D16 + 5V D17 D18 GND Descriptions Ground Reset Signal Power I/O Input
Ground
I/O Write I/O Read
Input Input
Address Address Address Address Address Address Address Address Address Address Address Address Address Address Address Address
Input Input Input Input Input Input Input Input Input Input Input Input Input Input Input Input
Interrupt Request Signal Interrupt Request Signal Interrupt Request Signal Interrupt Request Signal Interrupt Request Signal
Output Output Output Output Output
Power Ground 16 bits I/O repeating signal Interrupt Request Signal Interrupt Request Signal Interrupt Request Signal Interrupt Request Signal Interrupt Request Signal Output Output Output Output Output Output
Data Data Data Data Data Data Data Data
I/O I/O I/O I/O I/O I/O I/O I/O
Power Ground
2
MCX314
3.2. Pin Definition of I/O Connector
See the diagram below: when the first pin ( found, the upper cable, from right (red wire) to left are the ) is pins A1, A2, A3, ...A49, A50, and lower cable from right (red wire) to left are the pins B2, B3, ...B49, B50. , , Connector type: board side.. FX2B-100P -1.27DS(HIROSE) cable side.. FX2B-100S -1.27R(HIROSE)
I/O Connector
A50 A49 * * * * * * * * * * * * * A2 A1 B50 B49 * * * * * * * * * * * * * B2 B1
1 Pin
st
www..com
A50 A49 A2 A1
B50 B49
B2 B1
Pin A1 A2 A3 A4 A5 A6 A7 A8 A9
Signal Name VEX EMG XLMT+ XLMTXIN1 XIN2 XIN3 YLMT+ YLMT-
I/O Input Input Input Input Input Input Input Input Input Input Input Input Input Input Input Input Input Input Input Input Input Input Input Input Input Input Input Input Input Input Input Input
Contents External Power(DC12~24V) Emergency Stop (for all axes) + Direction Limit of X axis - Direction Limit of X axis Decelerating / Sudden Stop of X axis Decelerating / Sudden Stop of X axis Decelerating / Sudden Stop of X axis + Direction Limit of Y axis - Direction Limit of Y axis Decelerating / Sudden Stop of Y axis Decelerating / Sudden Stop of Y axis Decelerating / Sudden Stop of Y axis Servo In-positioning of X axis Servo Error of X axis Encoder Phase A of X axis Encoder Phase A of X axis Encoder Phase B of X axis Encoder Phase B of X axis Encoder Phase Z of X axis Encoder Phase Z of X axis Servo In-positioning of Y axis Servo Error of Y axis Encoder Phase A of Y axis Encoder Phase A of Y axis Encoder Phase B of Y axis Encoder Phase B of Y axis Encoder Phase Z of Y axis Encoder Phase Z of Y axis + Direction Drive Operation of X axis - Direction Drive Operation of X axis + Direction Drive Operation of Y axis - Direction Drive Operation of Y axis Ground
Pin B1 B2 B3 B4 B5 B6 B7 B8 B9
Signal Name VEX ZLMT+ ZLMTZIN1 ZIN2 ZIN3 ULMT+ ULMT-
I/O Input Input Input Input Input Input Input Input Input Input Input Input Input Input Input Input Input Input Input Input Input Input Input Input Input Input Input Input Input Input Input
Contents External Power (DC12~24V) + Direction Limit of Z axis - Direction Limit of Z axis Decelerating / Sudden Stop of Z axis Decelerating / Sudden Stop of Z axis Decelerating / Sudden Stop of Z axis + Direction Limit of U axis - Direction Limit of U axis Decelerating / Sudden Stop of U axis Decelerating / Sudden Stop of U axis Decelerating / Sudden Stop of U axis Servo In-positioning of Z axis Servo Error of Z axis Encoder Phase A of Z axis Encoder Phase A of Z axis Encoder Phase B of Z axis Encoder Phase B of Z axis Encoder Phase Z of Z axis Encoder Phase Z of Z axis In-positioning of U axis Servo Error of U axis Encoder Phase A of U axis Encoder Phase A of U axis Encoder Phase B of U axis Encoder Phase B of U axis Encoder Phase Z of U axis Encoder Phase Z of U axis + Direction Drive Operation of Z axis - Direction Drive Operation of Z axis + Direction Drive Operation of U axis - Direction Drive Operation of U axis Ground
A10 YIN1 A11 YIN2 A12 YIN3 A13 XINPOS A14 XALARM A15 XECAP A16 XECAN A17 XECBP A18 XECBN A19 XIN0P A20 XIN0N A21 YINPOS A22 YALARM A23 YECAP A24 YECAN A25 YECBP A26 YECBN A27 YIN0P A28 YIN0N A29 XEXOP+ A30 XEXOPA31 YEXOP+ A32 YEXOPA33 GND A34 XOUT4 A35 XOUT5 A36 XOUT6 A37 XOUT7 A38 XP+P A39 XP+N A40 XP-P A41 XP-N A42 GND
B10 UIN1 B11 UIN2 B12 UIN3 B13 ZINPOS B14 ZALARM B15 ZECAP B16 ZECAN B17 ZECBP B18 ZECBN B19 ZIN0P B20 ZIN0N B21 UINPOS B22 UALARM B23 UECAP B24 UECAN B25 UECBP B26 UECBN B27 UIN0P B28 UIN0N B29 ZEXOP+ B30 ZEXOPB31 UEXOP+ B32 UEXOPB33 GND B34 ZOUT4 B35 ZOUT5 B36 ZOUT6 B37 ZOUT7 B38 ZP+P B39 ZP+N B40 ZP-P B41 ZP-N B42 GND
Output General Purpose Output of X axis Output General Purpose Output of X axis Output General Purpose Output of X axis Output General Purpose Output of X axis Output + Direction Drive Pulse of X axis Output + Direction Drive Pulse of X axis Output - Direction Drive Pulse of X axis Output - Direction Drive Pulse of X axis Ground
Output General Purpose Output of Z axis Output General Purpose Output of Z axis Output General Purpose Output of Z axis Output General Purpose Output of Z axis Output + Direction Drive Pulse of Z axis Output + Direction Drive Pulse of Z axis Output - Direction Drive Pulse of Z axis Output - Direction Drive Pulse of Z axis Ground
3
MCX314
Pin Signal Name I/O Contents Pin Signal Name I/O Contents A43 YOUT4 A44 YOUT5 A45 YOUT6 A46 YOUT7 A47 YP+P A48 YP+N A49 YP-P A50 YP-N Output General Purpose Output of Y axis Output General Purpose Output of Y axis Output General Purpose Output of Y axis Output General Purpose Output of Y axis Output + Direction Drive Pulse of Y axis Output + Direction Drive Pulse of Y axis Output - Direction Drive Pulse of Y axis Output - Direction Drive Pulse of Y axis B43 UOUT4 B44 UOUT5 B45 UOUT6 B46 UOUT7 B47 UP+P B48 UP+N B49 UP-P B50 UP-N Output General Purpose Output of U axis Output General Purpose Output of U axis Output General Purpose Output of U axis Output General Purpose Output of U axis Output + Direction Drive Pulse of U axis Output + Direction Drive Pulse of U axis Output - Direction Drive Pulse of U axis Output - Direction Drive Pulse of U axis
www..com
4
MCX314
3.3. Drive Pulse Signal (nP+P, nP+N, nP-P, nP-N)
Drive pulse output signal is used for the + / - direction drive pulse output which is through the differential output line-driver (AM26LS31). nP+P is differential from nP+N, and nP-P is differential from nP-N. nP+N and nP-N are on the Low level while resetting. nP+N and nP-N are on the Hi level, It will become independent 2pulse mode while resetting. It is possible to change to 1-pulse 1-direction mode. Please refer to Chapters 2.6.2 and 4.5 of MCX314 manual.
J3
+5V MCX314
nPP/PLS Am26LS31, or eq. J3 2,8,14,20
3,9,15,21
nP+P
1,7,13,19
nP+N +5V
6,12,18,24
5,11,17,23
nP-P
4,10,16,22
www..com
nPM/DIR
nP-N
Output Signal Loop for Drive Pulses The above circuit shows each axis' s + / - direction output. J3 jumper can be switched for +5V output when the pulse input specification of motor driver needs the function. However, +5V is the power of internal circuit. The user should pay attention to the wiring, and prevent from the noise from external devices. Jumper table of J3 YP+P YP-P ZP+P 9 12 15 8 11 14 7 10 13
Output Signal + 5V Output Output Pin Line-driver Output
XP+P 3 2 1
XP-P 6 5 4
ZP-P 18 17 16
UP+P 21 20 19
UP-P 24 23 22
The original setting of 1-2, 4-5, 7-8, 10-11, 13-14, 16-17, 19-20 and 22-23 are shorted, which is line driver output. If 2-3, 5-6, 8-9, 11-12, 14-15, 17-18, 20-21, and 23-24 are shorted, +5V output can be used. The following figures show the connecting examples of motor driver and photo coupler / line-driver. Photo coupler input interface
+5V or XP+P XP+N +5V or XP-P XP-N CW+ CWCCW+ CCWMotor Driver Side
Line-driver input interface
XP+P XP+N XP-P XP-N GND Twist pair with shield CW+ CWCCW+ CCWGND + Am26LS32 + Am26LS32 Motor Driver side
5
MCX314
3.4. General Purpose Output Signal (nOUT7 ~ nOUT4)
General purpose output signals nOUT7/DSND, nOUT6/ASND, nOUT5/CMPM and nOUT4/CMPP are output through buffer (74LS06). Each output signal is " OFF" while resetting.
MCX314
nOUT7/DSND nOUT6/ASND nOUT5/CMPM
nOUT7 nOUT6 nOUT5 nOUT4
74LS06
nOUT4/CMPP
GND
DSND www..com
and ASND are used for acceleration / deceleration status output; CMPM and CMPP are used for position counter and compare register. Please refer to Chapters 2.6.8 and 4.6 of MCX314 manual for general purpose output, Chapters 2.6.7 and 4.6 for acceleration / deceleration status output and Chapters 2.3 and 4.6 for the comparison status of position counter and compare register.
3.5. Over Limit Signal (nLMT+, nLMT-)
Over limit signals are used for halting + / - direction drive pulses. This input signal is connected to the limit input of MCX314 through the connection of photo coupler and RC filter. External DC12~24V power supply is necessary for triggering the limit switch. The logical levels and decelerating stop / sudden stop are selectable during the mode setting. After resetting, MCX314 is active on the Low level, and the limit is active when the current flows to the signal terminal (nLMT+, nLMT-). Please refer to Chapter 4.5 of MCX314 manual for mode setting in details.
+5V MCX314 nLMTP 3.3K 0.01 +5V 10K nLMTM 3.3K 0.01 3.3K
TLP121 or eq.
VEX(12~24V) 10K
3.3K
nLMT+
nLMT-
Circuit Diagram for Movement Limit Input Signals The response time of this circuit takes about 0.2 ~ 0.4 mSEC because of the delay of photo coupled and RC filter. The following figure shows the example of connecting photo sensor and over limit signal. When bit D3 of X axis mode register 2 (XWR2) is set to 0 (the resetting mode), the limit is active when the sensor is sheltered. The shield wire should be used if the cable connection is long-distance. MC8041A VEX I DC12~24V EE-SX670 (OMRON)
XLMT+ Limit is active when sensor is sheltered. Example of Photo Sensor and Over Limit Signal Connection
6
MCX314
3.6. Decelerating / Sudden Stop Input Signal (nIN1, nIN2, nIN3)
Decelerating / sudden stop signal is for decelerating stop / sudden stop during the driving. In MCX314, each axis is with 4 inputs IN3~IN0, in which IN0 is for the interface feedback of encoder Z phase; nIN1, nIN2 and nIn3 are for home position and hear-by home position input signals. Enable / disable and logical levels can be set. When the mode is enabled, the driving will stop once this signal is active. The decelerating stop will be performed during the acceleration / deceleration driving; the sudden stop will be performed during the constant speed driving. For instance, when D6 and D7 bits of XWR3 register are set 1 and 0 for X axis' signal on the active Low level, the driving will be stopped when the current flows to the signal terminal XIN3. Please refer to Chapter 4.4 of MCX314 manual for mode setting in details.
read from the input register 1 and 2 (RR4, 5); they can be used for general purpose inputs.
MCX314 +5V 10K nIN3~1 3.3K 0.01
TLP121 or eq.
VEX(12~24V)
www..com
3.3K nIN3~1
The response time of this circuit takes about 0.2 ~ 0.4 mSEC because of the delay of photo coupled and RC filter.
nINPOS is the input signal corresponding to the in-position output of servo driver. Enable / disable and logical levels are selectable. When it is enabled, and after the driving is finished, this signal is active and standby. n-
nALARM is the input signal corresponding to the alarm output of servo driver. Enable / disable and logical ALARM bit of status register 2 (nRR2) becomes 1. The driving will be sudden stopped once this signal is in its active level during the driving.
14 bits of mode register 2 (nWR2) are set to 1 and 0 on active Low level, the current flows from nINPOS signal terminal is standby, and bit n-DRV of RRO register returns to 0. For nALSRM input signal, after D13 nALARM signal terminal becomes the alarm status. Please refer to Chapters 2.6.5 and 4.5 for information in details.
+5V MCX314 nINPOS 3.3K 0.01 +5V 10K nALARM 3.3K 0.01 3.3K
TLP121 or eq.
VEX(12~24V) 10K
3.3K
nINPOS
nALARM
Input Signal for Servo Driver External DC12~24V power supply is necessary for triggering the signal. For the status of these signals can be read from the input register 1 and 2 (RR4, 5); they can be used for general purpose inputs. The response time of this circuit takes about 0.2 ~ 0.4 mSEC because of the delay of photo coupled and RC filter.
7
MCX314
3.8. Encoder Input Signal (nECAP, nECAN, nECBP, nECBN, nIN0P, nIN0N)
Connecting with encoder 2-phase output signals or the encoder 2-phase output signals of servo driver, nECAP / N and nECBP / N input signals are for the input counting of MCX314 real position counter. UP/DOWN pulse input and mode setting are possible. Please refer to Chapters 2.3.1, 2.6.3 and 4.5 of MCX314 manual for information in details. Connecting with encoder or Z-phase output signal of servo driver, nIN0P and nIN0N input signals are for the driving stop while drive pulses are outputting. Enable / disable and logical levels can be set. When the mode is enabled, the drive pulse output is stopped once the signal is active during the driving.
+5V MCX314 nECA/PPIN 470 220 1K +5V 470 220 nECB/PPIM +5V 470 220 nIN0 1K NIN0N
TLP2630 or PC9D10
nECAP
www..com
nECAN nECBP 1K nECBN NIN0P
Circuit Diagram of Encoder Feedback Shown in the circuit diagram above, high speed photo coupler TLP2630 (TOSHIBA) or PC9D10 (SHARP) is used. The encoder output can be differential line-driver or open-collector. The figure below shows when n***P is on the Hi level and n***N is on the Low level, the signal of MCX314 is on the Low level; when n***P is on the Low level and n***N is on the Hi level, the signal of MCX314 is on the Hi level. For the signal delay time from input pin to MCX314 signal terminal is less than 100nSEC, the maximum 4MHz counting is possible for 2-phase pulse input. n***P H L Input signal n***N L H
MCX314 signal n**** L H
XECAP EC-A XECAN XECBP XECBN XINOP EC-Z XINON Encoder Side EC-B Am26LS31
Example of the Connection for Differential Output Line-driver
8
MCX314 The following figure shows the connection of encoder input signal and open collector output encoder.
+ DC Power VCC
XECAP XECAN XECBP XECBN
www..com
R
Encoder
EC-A R EC-B R EC-Z END Power Voltage
XINOP XINON
5 12 24
R() 0 820 1/4W 2K 1W
Example of the Connection for Open Collector Output
3.9. External Driving Control Input Signal (nEX0P+, nEX0P-)
This signal is for starting the +/- direction drive from external source. When the fixed pulse driving is commanded, the designated pulses will be output when the input signal is triggered. When the continuous driving is commanded, pulses will be output continuously when the input signal is on the Low level. Manual control for each axis can be progressed without the CPU involving. External DC12~24V power supply is necessary for triggering this signal. The response time of this circuit takes about 10 mSEC because of the delay of RC filter.
+5V MCX314 nEXPP 74HC14 100K 0.01 +5V 10K nEXPM 100K 0.01 3.3K
TLP121 or eq.
VEX(12~24V) 10K
3.3K
nEXOP+
nEXOP-
Circuit Diagram of External Driving Control Input Signal In order to insulate this signal from photo coupler internal circuit, and prevent the chattering from CR circuit, it is possible to connect input signal with manual connector. The figure below is the connection example of external driving control input for X axis.
9
MCX314
MC8041A VEX I DC12~24V
XEXOP+ XEXOPSW ON to Jog
Connection Example of External Driving Control Input
3.10 Emergency Stop Input Signal(EMG)
www..com When
emergency stop input signal is on its active level, the drive pulse output for all axes will be stopped. J4 jumper terminal on the board is used for switching the active level. When this signal is active during the driving, the driving axis will be stopped, and each axis' s error bit of main status register will become 1. Please refer to Chapters 2.6.6 and 4.1.2 of MCX314 manual for information in details.
+5V MCX314 J4 EMGN 1 3 2 4 74HC14
J4 :EMG logical setting (factory setting is J1-J2 short )
VEX(12~24V) 10K
3.3K 0.01
TLP121 or eq.
3.3K EMG
Circuit diagram for emergency stop input signal External DC12~24V power supply is necessary for triggering the signal. The response time of this circuit takes about 0.2 ~ 0.4 mSEC because of the delay of photo coupled and RC filter.
The figure below shows the display of J4 jumper:
J4 2 1 4 3
Short between pins 1 and 2: active when the emergent stop signal (EMG) and external GND are short Short between pins 3 and 4: active when the emergent stop signal (EMG) and external GND are opened The original setting is short between pins 1 and 2.
3.11 External Power Input (VEX)
External power input is for the operation of over limit input signals (nLMT+, nLMT-), decelerating / sudden stop input signals (nIN1~3), external driving command input signals (nINP0S, nALARM) and emergency stop input signal (EMG) for each axis. The proper power supply is DC12V~24V. Current consumption of 1 input signal is: 3.3mA at DC12V, 7mA at DC24V = 7.
10
MCX314
4. Interrupt Setting
Through J2 jumper terminal, total ten interrupt request signals at ISA bus can be connected. When the interrupt occurs in MCX314, the interrupt request signal (IRQn) will become Hi level from Low level. After the status register 3 (nRR3) of the interrupted axis is read, this interrupt request signal will return to the Low level. Please refer to Chapters 2.5, 4.4 and 4.13 for interrupt functions.
+5V ISA BUS IRQ3 IRQ4 IRQ5 IRQ6 IRQ7 IRQ10 IRQ11 IRQ12 IRQ14 IRQ15 1 3 5 7 9 11 13 15 17 19 J2 2 4 6 8 10 12 14 16 18 20
MCX314 INTN
74LS04
www..com
The table below shows the shorted pins at J2 jumper corresponding to the interrupt request signals at ISA bus:
Interrupt Request Signal IRQ3 IRQ4 IRQ5 IRQ6 IRQ7 IRQ10 IRQ11 IRQ12 IRQ14 IRQ15
Short at J2 Jumper between pins 1-2 between pins 3-4 between pins 5-6 between pins 7-8 between pins 9-10 between pins 11-12 between pins 13-14 between pins 15-16 between pins 17-18 between pins 19-20
The initial setting is shorted between pins 2 and 4, so there is no interrupt request to CPU. [Note] For 74ALS04 is used for outputting interrupt signals, the interrupt request signals should not be used for other devices or for other I/O boards of PC.
11
MCX314
5. Connection Examples for Motor Drivers
5.1. Connection with Stepper Motor Drivers
The figure below is the example of MC8041A connected to a 5-phase micro-step driver, KR515M, manufactured by TECHNO DRIVE.
MC8041A XP+P XP+N XP-P
www..com
KR515M CW Pulse CCW Pulse Hold Off F+ FR+ RH.O.+ H.O.M1/M2 select D.S.+ D.S.-
XP-N XOUT4 XOUT5 XINOP XINON GND
Timing Output
Z.P.+ Z.P.-
Note 1: J3 of MC8041A is set at +5V output side for output terminals XP+P and XP-P. Please be very careful that the external noise may happen during the wiring. Note 2: Hold off, M1 / M2 select and timing output can be wired if necessary. The hold off and M1 /M2 select signals can be controlled by writing 0 and 1 into bits D8 and D9 of WR3 register of MCX314. For timing output signal, the signal level can be read through RR4 and RR5 registers. The figure below is the example of MC8041A connected to UPK series stepper drivers manufactured by ORIENTAL.
MC8041A XP+P XP+N XP-P XP-N XOUT4 + GND VEX XIN1 XALARM DC24V Timing Output Over Heat TIMMING O. HEAT COM CW Pulse CCW Pulse 2K/1w Hold Off UPK series CW+ CWCCW+ CCWH.OFF+ H.OFF-
Note 1: Hold off, timing output and over heat can be wired if necessary. The hold off signal can be controlled by writing 0 and 1 into bit D8 of WR3 register of MCX314.For timing output signal, the home position searching can be performed through the bits D0 and D1 of WR1 register mode setting. For over heat signal, the alarm function can be performed through the bits D12 and D13 of WR2 register mode setting. For timing output and over heat signals, the signal level can be read through RR4 and RR5 registers.
Note 2: The user can use twist pair cable for long-distance connection or for a strong noise circumstance.
12
MCX314
5.2 Connection with Pulse-type Servo Motor Drives
The figure below is the example of MC8041A connected to MINAS XX series AC servo driver manufactured by PANASONIC.
MC8041A I/O Connector XP+P XP+N XP-P XP-N
www..com
MINAS XX series CNI/F CW Pulse CCW Pulse CW+ CWCCW+ CCW-
XECAP XECAN XECBP XECBN XINOP XINON GND XOUT4 XOUT5 XOUT6 GND +
Encoder Phase A Encoder Phase B Encoder Phase Z
OA+ OAOB+ OBOZ+ OZGND COM+ SRV-ON CL A-CLR COM-
Servo On Error Counter Clear Alarm Clear
DC24V VEX XIN3 XALARM XINPOS XLMT+ XLMTXIN1 XIN2 Servo Ready Servo Alarm Completing Position
S-RDY ALM COIN CW DIR. LIMIT CCW DIR. LIMIT HOME Near by HOME
Note 1: The servo driver should be engaged in position control mode and the pulse input is set the CW/CCW pulse mode. This connection is not proper for pulse / direction mode because the t6 time will not be enough. Note 2: Encoder A / B phase can be connected when the real position counter of MCX314 is used for counting. It is not necessary to connect the real position data at CPU side, neither to connect other signals. Note 3: The user can use twist pair cable for long-distance connection or for a strong noise circumstance.
13
MCX314
6. I/O Signal Timing
6.1 Power-on Reset
+5V RESDRV nPP nPN
www..com
Low Hi * OFF Invalid Valid
nOUT4~7 Read/Write
Drive pulse output signals (nP P, nP N) and general purpose output signals (nOUT4 ~ 7) will be determined after 250 nSEC from the reset signal of ISA bus (RESDRV) rising. - For data reading and writing is possible from 500 nSEC the reset signal (RESDRV) o .
6.2 Individual Driving
BUSYN Interpolation drive command write in * nPP-P direction signal
Pre state
nPPP
1st pulse
Valid level
2nd pulse
The maximum time from the driving command write-in to the first pulse starting is about 650nSEC. -(R) When the drive output pulse type is 1-pulse 1-direction, the direction signal (nP-P) will be in its valid level within maximum 275 nSEC, and then first pulse will be output within 375 nSEC after the direction signal is in its valid level.
6.3 Interpolation Driving
BUSYN Interpolation drive command write in * nPP-P direction signal
Not stable
nPPP
1st pulse Valid level
Not stable
2nd pulse Valid level
Not stable
After interpolation command is written, the first pulse will be output within 775 nSEC. - When the drive output pulse type is 1-pulse 1-direction, the direction signal (nP-P) will be in its valid level before and after 125 mSEC once the drive pulse is on the Hi level.
14
MCX314
6.4 Input Pulse Timing
n A/B Quadrature Pulse Input
Counting up nECAP nECAN nECBP nECBN
www..com
Counting down
*
*
*
*
*
*
*
*
Minimum time difference between EC-A and EC-B: 200 nSEC. n Up / Down Pulse Input
nECAP nECAN nECBP nECBN *
Minimum Up / Down pulse width: 130 nSEC - Minimum UpODown pulse Interval: 260nSEC (R) Minimum Up / Down pulse cycle: 260 nSEC
*
*
*
15
MCX314
6.5 Sudden Stop Timing
n External Sudden Stop Signal EMG, nLMT nIN3,2,1,0 nPP
Valid level
*
When external stop signal is enabled during the driving, up to 400 SEC, + 1 pulse will be output, then stopped. n Sudden Stop Command
www..com
IOW*
Stop command write in
nPP
- When the stop command issued during the driving, at most one pulse will be output, then the driving is stopped.
6.6 Decelerating Stop Timing
n External Decelerating Stop Signal nLMT nIN3,2,1,0 nPP
Valid level
*
When the external decelerating stop signal is enabled during the driving, up to 400 SEC, + 2 pules will be output, then stopped. n Decelerating Stop Command IOW*
active
Decelerating command write in
nPP
- When the decelerating stop command is issued during the driving, at most two pulses will be output, then the driving starts decelerating.
16
MCX314
7. Jumper and Switch Layout
163 161 11 3 1
www..com
SW2
SW1 J3
24
1820 2 4 1719 1 3
24 13
J2
13
J1 J4 ISA BUS
69.85 2.54 X 17 48 2.54 X 30 81 3.2 10 18.6 63.4
SW1,2 J1 J2 J3 J4
: I/O address setting switches (see Chapter 2). : J1-2 short circuit (initial setting) -- Please don' t change. : jumper for interrupt request signal setting : jumper for drive pulse / +5V switching (see Chapter 3.3) : jumper for selecting EMG signal active level (see Chapter 3.9)
17
120
14
16
22
92.2
36
+5V 24
22.1
MCX314
8. Specifications
< Axial Control 4 axes www..com Circular
Interpolation -- any 2 of 4 axes Range: -8,388,608 ~ +8,388,607; Accuracy: O 1LSB; Speed: 1PPS ~ 4MPPS
Bit Pattern Interpolation -- any 2 / 3 of 4 axes, for CPU calculation Continuous Interpolation: performing linear and circular interpolations continually Highest drive speed of continuous interpolation: 2MHz Other functions: interpolating axes selection, constant surface speed control, interpolating steps performance
for each axis...
18
MCX314 19
MCX314
www..com
MCX314
4-Axis Motion Control IC
20
MCX314
Contents
1. OUTLINE . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 1 2. The Descriptions of Functions. . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 4 2.1 Pulse Output Command . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 4 2.1.1 Fixed Pulse Driving Output . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 4 2.1.2 Continuous Pulse Driving Output. . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 5 2.2 Speed Curve. . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 5 2.2.1 Constant Speed Driving . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 5 2.2.2 Trapezoidal Driving . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 6 2.2.3 S-curve Acceleration/Deceleration Driving . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 7 2.2.4 Pulse Width and Speed Accuracy . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 9 2.3 Position Control . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 11 w w w . D a t a S h e e2.3.1o m t 4 U . c Logic Position Counter and Real position Counter . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 11 2.3.2 Compare Register and Software Limit . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 11 2.4 Interpolation . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 12 2.4.1 Linear Interpolation . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 12 2.4.2 Circular Interpolation . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 14 2.4.3 The Bit Pattern Interpolation . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 16 2.4.4 Constant Vector Speed . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 19 2.4.5 Continuous Interpolation . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 21 2.4.6 The Acceleration / Deceleration Control in Interpolation. . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 24 2.4.6 Single-step interpolation (from Command or External Signal) . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 27 2.5 Interrupt . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 28 2.6 Other Functions. . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 29 2.6.1 Driving By External Pulses . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 29 2.6.2 Pulse Output Type Selection . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 30 2.6.3 Pulse Input Type Selection . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 30 2.6.4 Hardware Limit Signals . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 30 2.6.5 Interface to Servo Motor Drivers . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 31 2.6.6 Emergency Stop . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 31 2.6.7 Status Output . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 31 2.6.8 General Purpose Output. . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 31 3. Pin Assignments and Signal Description . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 33 4. Register . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 38 4.1 Register Address by 16-bit Data Bus . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 4.2 Register Address by 8-bit Data Bus . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 4.3 Command Register: WR0 . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 4.4 Mode Register1: WR1 . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 4.5 Mode Register2: WR2 . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 4.6 Mode Register3: WR3 . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 4.7 Output Register: WR4 . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 4.8 Interpolation Mode Register: WR5 . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 4.9 Data Register: WR6/WR7 . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 4.10 Main Status Register: RR0 . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 4.11 Status Register 1: RR1 . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 4.12 Status Register 2: RR2 . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 4.13 Status Register 3: RR3 . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 4.14 Input Register: RR4 / RR5 . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 4.15 Data-Read Register: RR6 / RR7 . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 38 40 41 41 42 43 45 45 46 47 48 49 49 50 50
5. Command Lists . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 51 6. Commands for Data Writing . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 53 6.1 6.2 6.3 6.4 6.5 6.6 Range Setting . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . S-curve Acceleration Rate Setting . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . Acceleration Setting. . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . Deceleration Setting. . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . Initial Speed Setting . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . Drive Speed Setting . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . .
21
53 53 54 54 54 55
MCX314 6.7 Output Pulse Number / Interpolation Finish Point Setting . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 6.8 Manual Decelerating Point Setting . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 6.9 Circular Center Setting . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 6.10 Logical Position Counter Setting . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 6.11 Real position Counter Setting . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 6.12 COMP+ Register Setting . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 6.13 COMP- Register Setting . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 6.14 Acceleration Counter Offsetting . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 6.15 NOP (Used for Axis Switching) . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . .
55 55 56 56 56 56 56 57 57
7. Commands for Reading Data . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 58 7.1 7.2 7.3 7.4 Logical Position Counter Reading . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . Real position Counter Reading . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . Current Drive Speed Reading . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . Current Acceleration / Deceleration Reading . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 58 58 58 58
w w w . D a t a8. e e t 4 U . c o m S h Driving Commands
. . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 59 59 59 59 60 60 60 60 60
8.1 8.2 8.3 8.4 8.5 8.6 8.7 8.8
+Direction Fixed Pulse Driving . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . -Direction Fixed Pulse Driving . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . +Direction Continuous Driving . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . -Direction Continuous Driving . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . Drive Status Holding . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . Drive Status Holding Release / Finishing Status Clear. . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . Decelerating Stop . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . Sudden Stop . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . .
9. Interpolation Commands . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 61 9.1 2-Axis Linear Interpolation . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 9.2 3-Axis Linear Interpolation . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 9.3 CW Circular Interpolation . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 9.4 CCW Circular Interpolation . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 9.5 2-Axis Bit Pattern Interpolation . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 9.6 3-Axis Bit Pattern Interpolation Drive . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 9.7 BP Register Data Writing Enabling . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 9.8 BP Register Data Writing Disabling . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 9.9 BP Data Stack . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 9.10 BP Data Clear . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 9.11 Single Step Interpolation . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 9.12 Deceleration Enabling . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 9.13 Deceleration Disabling. . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 9.14 Interpolation Interrupt Clear . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 61 61 61 61 61 62 62 62 62 63 63 63 63 63
10. Connection Examples. . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 64 10.1 10.2 10.3 10.4 10.5 10.6 Connection Example for 68000 CPU . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . Connection Example for Z80 CPU . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . Connection Example . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . Pulse Output Interface . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . Connection Example for Input Signals . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . Connection Example for Encoder . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 64 64 65 65 66 66
11. Example Program . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 67 12. Electrical Characteristics. . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 70 12.1 DC Characteristics . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 12.2 AC Characteristic . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 12.2.1 Clock . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 12.2.2 Read / Write Cycle . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 12.2.3 BUSYN Signal . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 12.2.4 SCLK/Output Signal Timing . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 12.2.5 Input Pulses . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 12.2.6 General Purpose Input / Output Signals . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 70 70 70 71 71 71 72 72
13. Timing of Input / Output Signals . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 73 13.1 Power-On Reset. . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 73 13.2 Fixed Pulse or Continuous Driving . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 73 22
13.3 13.4 13.5 13.6
MCX314 Interpolation. . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 74 Start Driving after Hold Command. . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 74 Sudden Stop . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 74 Decelerating Stop . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 74
14. Pinout . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 76 15. Specifications . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 77 Appendix A: Speed Curve Profile . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . 1
www..com
23
www..com
MCX314
1. OUTLINE
MCX314 is a 4-axis motion control IC which can control 4 axes of either stepper motor or pulse type servo driveers for position, speed, and interpolation controls. All of the MCX314' s function are controlled by specific registers. There are command registers, data registers, status registers and mode registers. This motion control IC has the following built-in functions:
n Individual Control for 4 Axes
Each of the four axes has identical function capabilities, and is controlled by the same method of operation with constant speed, trapezoidal or S-curve driving. n Speed Control The speed range of the pulse output is from 1PPS to 4MPPS for constant speed, trapezoidal or S-curve acceleration/deceleration driving. The accuracy of the frequency of the pulse output is less than +/- 0.1% (at CLK=16MHz). The speed of driving pulse output can be freely changed during the driving.
www..com n S-curve
Acceleration and Deceleration
Each axis can be preset with S-curve or trapezoidal acceleration/deceleration individually. Using S-curve command will drive the output pulse in a parabolic shaped acceleration and deceleration. Besides these, MCX314 has a special method to prevent from the happening of triangular curve when S-curve is commanded.
n Linear Interpolation
Any 2 or 3 axes can be selected to perform linear interpolation. The position boundary is between coordinates -8,388,608 and +8,388,607, and the positioning error is within +/- 0.5 LSB (Least Significant Bit). The interpolation speed range is from 1 PPS to 4 MPPS.
n Circular Interpolation
Any 2 axes can be selected to perform circular interpolation. The position boundary is between coordinates -8,388,608 and +8,388,607, and the positioning error is within +/- 1.0 LSB. The interpolation speed range is from 1 PPS to 4 MPPS.
n Bit Pattern Interpolation
Any 2 or 3 axes can be selected to perform the bit pattern interpolation, and the interpolation data is calculated by CPU; CPU writes the bit data into MCX314. Then, MCX314 outputs pulses continuously at the preset driving speed. So, the user can process any interpolation curve by this mode.
n Continuous Interpolation Different interpolation methods can be used continuously, linear interpolation -> circular interpolation -> linear interpolation ...The maximum driving speed of performing continuous ,
interpolation is 2 MHz.
n Constant Vector Speed Control
This function performs a constant vector speed. During the interpolation driving, MCX314 can set a 1.414 times pulse cycle for 2-axis simultaneous pulse output, and a 1.732-time pulse cycle for 3-axis simultaneous pulse output. n Position Control
Each axis has a 32-bit logic position counter and a 32-bits real position counter. The logic position
counter counts the output pulse numbers, and the real position counter counts the feedback pulse numbers from the external encoder or linear scale.
n Compare Register and Software Limit
Each axis has two 32-bit compare registers for logical position counter and real position counter. The comparison result can be read from the status registers. The comparison result can be notified by an interrupt signal. These registers can be also functioned as software limits. n Driving by External Signal It is possible to control each axis by external signals. The +/- direction fixed pulse driving and continuous driving can be also performed through the external signals. This function is used for JOG or teaching modes, and will share the CPU load.
n
Input/ Output Signal
Each axis has 4 points of input signals to perform deceleration and stop in driving. These input signals are for high-speed near-by home search, home search and z-phase search during the home returning. Each axis is with 8 output points for general output.
1
MCX314
n Servo Motor Feedback Signals
Each axis includes input pins for servo feedback signals such as in-positioning, close loop positioning control and servo alarm.
n Interrupt Signals
Interrupt signals can be generated when: (1). the start / finish of a constant speed drive during the trapezoidal driving, (2). the end of driving, and (3). the compare result once higher / lower the border-lines of the position counter range. An interrupt signal can be also generated during the interpolation driving. n Real Time Monitoring During the driving, the present status such as logical position, real position, drive speed, acceleration / deceleration, status of accelerating / decelerating and constant driving can be read.
n 8 or 16 Bits Data Bus Selectable MCX314 can be connected to either 8-bit or 16-bit CPU
www..com
Figure 1.1 is the IC functional block diagram. It consists of same functioned X, Y, Z and U axes control sections and interpolation counting sections. Figure 1.2 is the functional block diagram of each axis control section.
CSN RDN WRN A3~A0 D15~D0 BUSYN
Command/Data Interpretation/ Process Section
Leaner Interpolation Counting Section 2 axes/3 axes
AX1P+ AX1PAX2P+ AX2PAX3P+ AX3PAX1P+ AX1PAX2P+ AX2PAX1P+ AX1PAX2P+ AX2PAX3P+ AX3P-
XP+ XP-
Circle Interpolation Counting Section Interpolation Control Section. INT 2 axes Bit Interpolation Counting Section 2 axes/3 axes
Pulse separate
YP+ YP-
ZP+ ZP-
UP+ UP-
Main axis pulse X Axis Control Section INT Main axis pulse Y Axis Control Section INT Main axis pulse Z Axis Control Section INT Main axis pulse U Axis Control Section INT
INTN
XP+ XP-
X AXIS I/O
YP+ YP-
ZP+ ZP-
Y AXIS I/O Z AXIS I/O
UP+ UP-
U AXIS I/O
Interrupt Generator
Figure 1.1 MCX314 Functional Block Diagram
2
MCX314
P+ PCommand Operating Section Action Managing Section
Jerk Generator
To Interpolate Section
Main Axis Pulse
Command /Data External Signal
www..com
Acceleration/Deceleration Generator
EXPP EXPM
External Operation Section.
Speed Generator
External Signal
P+
Pulse Generator P-
Wave Change
PP/PLS PM/DIR
UP
Logical Position Counter(32bit)
DOWN
INT
Interrupt Generator
UP
Real Position Counter
DOWN
Wave Change
EC-A EC-B
COMP+
Compare Register
Selector
Compare Register
Input Signal Management Section
LMTP LMTM INPOS ALARM EMGN IN3~0
COMPGeneral output OUT3~0 General output OUT7~4
OUT3~0
Selector
OUT7~4
Note 1: EMGN is for all axes use.
Fig.1.2 Control Block Diagram
3
MCX314
2. The Descriptions of Functions
2.1 Pulse Output Command
There are two kinds of pulse output commands: fixed pulse driving output and continuous pulse driving output.
2.1.1 Fixed Pulse Driving Output
When host CPU writes a pulse numbers into MCX314 for fixed pulse driving, and configures the performance such as acceleration / deceleration, speed. MCX314 will generate the pulses and output them automatically. When output pulse numbers are equal to the command pulse numbers, MCX314 stops the output. The profile is showing in Fig.2-1. Concerning the execution of fixed pulse driving in acceleration / deceleration, it is necessary to set the following parameters: z Range z Acceleration/Deceleration z Initial Speed z Driving Speed zOutput Pulse Numbers R A/D SV V P
Driving Speed
www..com
Auto Deceleration
Initial Speed
Specific Output Pulse Finished Fig. 2.1 Fixed Pulse Driving Time
nChanging Output Pulse Numbers in Driving
The output pulse numbers can be changed in the fixed pulse driving. If the command is for increasing the output pulse, the pulse output profile is shown as Fig. 2.2 or 2.3. If the command is for decreasing the output pulses, the output pulse will be stopped immediately as shown in Fig. 2.4. Furthermore, when in the S-curve acceleration /deceleration driving mode, the output pulse number change will occur to an incomplete deceleration S-curve.
Driving Speed
Change of Output Pulse
Initial Speed
Time
Fig. 2.2 Changing The Output Pulse Numbers in Driving deceleration
Driving Speed
Initial Speed
Change of Output Pulse
Initial Speed
Change of Output Pulse Time
Time Fig. 2.3 Changing Command During Deceleration
Fig.2.4 Changing The Lesser Pulse Numbers Than Output Pulse Stop
nManual Setting Deceleration for fixed pulse Acceleration/Deceleration Driving
As shown in Fig. 2.1, generally the deceleration of fixed pulse acceleration /deceleration driving is controlled automatically by MCX314. However, in the following situations, it should be preset the deceleration point by the users. l The change of speed is too often in the trapezoidal fixed pulse acceleration/deceleration driving. l When use circular interpolation, bit pattern interpolation and continuous interpolation for acceleration and deceleration. In case of manual deceleration, please set D0 bit of register WR3 to 1, and use command (07h) for presetting deceleration point. As to the other operation, the setting is as same as that of fixed pulse driving.
4
MCX314
nOffset Setting for Acceleration/Deceleration Driving
The offset function can be used for compensating the pulses when the decelerating speed doesn' t reach the setting initial speed during the S-curve fixed pulse driving. MCX314 will calculate the acceleration / deceleration point automatically, and will arrange the pulse numbers in acceleration equal to that in deceleration. The method is calculating the output acceleration pulses and comparing them with the remaining pulses. When the remaining pulses are equal to or less the pulses in acceleration, it start the deceleration.
Driving Speed Shift Pulse
Initial Speed
When setting the offset for deceleration, MCX314 will Fig.2.5 Remaining Pulse in Acc. / Dec. Fixed Pulse start deceleration early for the offset. The remaining Driving pulses of offset will be driving output at the initial speed (see Fig. 2.5). The default value for offset is 8 when MCX314 power-on reset. It is not necessary to change the shift pulse www..com in the case of acceleration/deceleration fixed pulse driving. value
Time
2.1.2 Continuous Pulse Driving Output
When the continuous driving is performed, MCX314 will drive pulse output in a specific speed until stop command or external stop signal is happened. The main application of continuous driving is: home searching, teaching or speed control. Two stop commands are for stopping the continuous driving. One is " decelerating stop" , and the other is " sudden stop" . Four input pins, IN3~IN0, of each axis can be connected for external decelerating and sudden stop signals. Enable / disable, active levels and mode setting are possible.
Driving Speed
Stop Command or External Stop Signal Initial Speed
Time Fig.2.6 Continuos Driving
nStop Condition for External Input IN3~IN0 in Continuous Driving
The input pins IN3~IN0 can be used for home searching, near-by home searching and Z-phase searching . Enable / disable and logical levels can be set at WR1 of each axis. For the application of high-speed searching, the user can set MCX314 in the acceleration/deceleration continuous driving mode and enable IN1 in WR1. And then, MCX314 will perform the decelerating stop when the external signal IN1 is active. For the application of low-speed searching, the user can set MCX314 in the constant-speed continuous driving and enable IN1. Then, MCX314 will perform the sudden stop when IN1 is active.
2.2 Speed Curve
The speed driving profile in MCX314 can be configured as constant speed driving, trapezoidal driving or Scurve acceleration/deceleration.
2.2.1 Constant Speed Driving
When the driving speed set in MCX314 is lower than the Speed initial speed, the acceleration / deceleration will not be performed, instead, a constant speed driving starts. Initial Speed If the user wants to perform the sudden stop when the Driving Speed home sensor or encoder Z-phase signal is active, it is better not to perform the acceleration / deceleration driving, but the low-speed constant driving from the beginning. Fig.2.7 Constant Speed Driving For processing constant speed driving, the following parameters will be preset accordingly. z Range R z Initial Speed SV z Drive Speed V ; Output Pulse Numbers P (Only applicable for the fixed pulse driving) The items should be preset in accordance with the requirement.
5
Time
MCX314
nExample for Parameter Setting of Constant Speed
The constant speed is set 980 pps as shown in the right Figure. z Range R = 8,000,000: Multiple(M) = 1 z Initial Speed SV=980: Initial Speed Driving Speed z Driving Speed V=980: Should be less than initial speed Please refer each parameter in Chapter 6.
Speed(PPS)
980
Time(SEC)
2.2.2 Trapezoidal Driving
Trapezoidal driving is starting from the initial speed to the designated drive speed. The accelerating pulses Acceleration Drive Speed will be counted, and the deceleration (automatic deceleration) starts from the drive speed to initial speed once the remaining pulse numbers are less Acceleration(slope) than the accelerating pulse numbers. www..com When the decelerating stop command is performed output pulse is too low, not during the acceleration, or when the pulse numbers of Initial Speed suitable for the requirement of drive speed the fixed pulse drive do not reach the designated drive Time speed, the driving will be decelerating during Fig.2.8 Trapezoidal Driving acceleration, as show in Fig. 2.8. (triangle driving profile prevention, see appendix A3) Usually, the user should set the same acceleration and deceleration rates. For some cases, the acceleration and deceleration can be set individually by setting the D1 of WR3 to 1. When the deceleration is set individually in fixed pulse driving, the automatic deceleration will not be performed, but the manual deceleration is required. The user should set the bit D1 of Register WR3 as 1, then use decelerating command (03h) to set the deceleration. When performing the trapezoidal driving, the following parameters should be preset. z Range R z Acceleration A : Acceleration and deceleration ; Deceleration D : Option for individual deceleration. z Initial Speed SV z Driving Speed V ; Output Pulse Number P : Only for fixed pulse driving The ; items should be preset in accordance with the requirement.
nThe example of setting Trapezoidal Driving
Shown in the figure right hand side, acceleration is form the initial speed 500 PPS to 15,000 PPS in 0.3 sec.
15,000 Speed(PPS)
R = 4,000,000; Multiple(M)= 2 A=193 (15,000-500/0.3 =48,333 48,333/125/M = 193) z Initial Speed SV = 250 (500/M = 250) z Drive Speed V = 7,500 (15,000/M = 7,500) Please refer Chapter 6.
z Range z Acceleration
500 0.3 Time(SEC)
6
MCX314
2.2.3 S-curve Acceleration/Deceleration Driving
In case of S-curve acceleration / deceleration driving, the acceleration profile is not linear. The value of acceleration / deceleration is shaped as the trapezoid; see Fig. 2.9. In acceleration, there are three regions with different acceleration values. At the beginning, the acceleration increase linearly from 0 to the specific value A with a specific rate of acceleration K, which shows the driving speed increase parabolically in this region. Then, the driving speed increases in a constant acceleration in region b. And, in section c, the acceleration decelerates linearly to 0 with the rate of deceleration K. So the acceleration of S-curve includes regions a, b and c. www..com In deceleration, as same as acceleration, the driving speed decelerate parabolically in three regions d, e and f.
Speed Desired Drive Speed (V) a b c d e f
Initial Speed Acceleration/ Deceleration Specific value (A)
Time
Time Acceleratio Deceleration Fig.2.9 S-Curve Acceleration/Deceleration Driving
nComplete S-curve and Partial S-curve
The desired driving speed is V. When V (speed in region a) speed in region a, the region b will disappear. This condition is called complete S-curve. Otherwise, it is called partial S-curve. Please check the parameters and examples in Appendix A. In order to execute S-curve acceleration / deceleration, the user has to set bit D2 of register WR3 to 1, and the following parameters are necessary to be set. z Range R z Jerk K z Acceleration A : The designated value of acceleration and deceleration ; Deceleration D : The designated deceleration value of individual setting z Initial Speed SV z Drive Speed V ; Output Pulse Number P : Used for fixed pulse driving
nThe Prevention of Triangle Driving Profile
When the fixed pulse trapezoidal driving is performed, and also when the deceleration is performed before the acceleration stops, the triangle driving profile is coming out. The prevention of triangle driving profile in S-curve acceleration / deceleration driving will be discussed as follows. If the initial speed is 0, and if the rate of acceleration is a, then the speed at time t in acceleration region can be described as following. v(t) = at2 Therefore, the total output pulse number p(t) from time 0 to t is the integrated of speed. p(t) = 1/3 x at3 The total output pulse is (1/3+2/3+1+2/3+1+1/3) x at3 = 4 at3
Acc. Dec. Speed 2/3 at2 p(t) 1 Initial Speed Acceleration 1/3 1 1/3 Time 2/3
so p(t) = 1/12 (total pulse output)
Time
Fig. 2.10 The rule of 1/12 of Parabolic Acceleration/Deceleration
Therefore, when the output pulse in acceleration of S-curve is more than 1/12 of total output pulse, MCX314 will stop increasing acceleration and start to decrease the acceleration value.
7
MCX314
nThe Decelerating Stop for Preventing the Triangle Driving Profile in S-curve Driving
When the decelerating stop is commanded, or when the external signals IN3~IN0 are active during the Scurve acceleration / deceleration driving, the acceleration rate is decreasing, then the deceleration starts when the acceleration rate reaches 0.
Speed
Time Acceleration Decrease the Acceleration value
Time Acc. become zero, Dec. begins *Request for Decelerating Stop Fig. 2.11 Decelerating Stop During S-curve Acc./ Dec. Driving
www..com
nConstraints for S-curve Acceleration / Deceleration Driving
l The drive speed cannot be changed during the fixed pulse S-curve acceleration / deceleration driving. l When the fixed-pulse S-curve acceleration / deceleration driving is performed, the change of the output pulse numbers during the deceleration will not result a normal S-curve driving profile. l In case of executing circular interpolation, bit pattern interpolation and continuous interpolation, Scurve acceleration/deceleration cannot be executed normally. l If the S-curve output pulses run out before the deceleration to the initial speed, the user can use offset function. l When the S-curve output pulses are decelerating to the initial speed, but still some pulses remains, the user can modify the parameter K and driving speed V to avoid this situation.
nExample of Setting Parameters (Complete S-curve Acceleration /Deceleration)
*Setting a complete S-curve acceleration to output the drive speed from 0 to 40K PPS in 0.4 sec. As shown in Fig. Ex.3, if complete S-curve acceleration is required, the driving must be 20K PPS at time 0.2sec. And then, it will accelerate to 40K PPS at time 0.4sec. Speed PPS To calculate the maximum acceleration value acc. at time 40000 0.2sec, we know the speed at time 0.2sec is 20K PPS. So we get
20000
so,
20000PPS = 0.2sec x acc. /2 acc. = 200K PPS/sec
0 Acceleration PPS/SEC acc. =200K
20000PPS
To calculate the jerk, we get 200KPPS/0.2sec=1000KPPS/sec2
0.2
0.4
SEC
In a complete S-curve acceleration/deceleration, the speed 0 0.2 curve is depended on the jerk. Since the acceleration / deceleration does not exit in the partial S-curve, it should be preset over than 200KPPS/SEC. z Range R = 800,000 ; multiple(M) = 10 6 2 z Jerk K = 625 ; ((62.5 x 10 )/625) x 10 = 1,000KPPS/SEC z Acceleration A = 160 ; 125 x 160 x 10 = 200KPPS z Initial Speed SV = 100 ; 100 x 10 = 1000KPPS z Drive Speed V = 4000 ; 4000x 10 = 40,000PPS Please refer each parameter in Chapter 6.
0.4
SEC
8
MCX314
nExample of Parameter Setting (Partial S-curve Acceleration / Deceleration)
*Setting a partial S-curve acceleration to output the drive speed from 0 to 40K PPS in 0.6 sec. At first, a parabolic accelerating is executed to 10KPPS in 0.2 sec., then the linear acceleration goes up to 30KPPS, and then the parabolic acceleration reaches to 40KPPS. We get 10K PPS = Acceleration x 0.2sec / 2 Acceleration = 100K PPS/sec And, the jerk is 100KPPS/sec/0.2sec=500KPPS/sec2 z Range www..com z Jerk z Acceleration
R = 800,000 : multiple = 10 6 K = 1250 : ((62.5 x 10 )/1250) x 10 3 2 =500 x 10 PPS/SEC 3 A = 80 : 125x80x10 =100x10 PPS/SEC SV = 100 : 100 x 10 = 1000 PPS V = 4,000 : 4,000 x 10 = 40,000 PPS
Speed PPS 40000 30000
10000 0 Acceleration PPS/SEC 100K 0.2 0.4 0.6 SEC
0
10000PPS
z Initial Speed z Drive Speed Please refer each parameter in Chapter 6.
0.2
0.4
0.6
SEC
2.2.4 Pulse Width and Speed Accuracy nDuty Ratio of Driving Pulse
The period time of + /- direction pulse driving of each axis is decided by system clock CLK. The tolerance is within 1SCLK (For CLK=16MHz, the tolerance is 125nSEC). Basically, the duty ratio of each pulse is 50% as show in Fig. 2.12. When the parameter setting is R=8,000,000 and V=1000 (Multiple=1, V=1000PPS), the driving pulse is 500uSEC on its Hi level and 50uSEC on its Low level and the period is 1mSEC.
500S
500S
R = 8000000 SV = 1000 V = 1000
1.00mS
Fig. 2.12 Output of Drive Pulse (1000PPS)
However, during the acceleration / deceleration driving, the Low level pulse length is shorter than that of Hi level pulse during the acceleration; the Low level pulse is longer than that of Hi level pulse during the deceleration. See Fig. 2.13.
Acceleration Area
Constant speed Area
Deceleration Area
tHA
tLA
tHC tHC=tLC
tLC
tHA>tLA
tHD tLD tHDFig. 2.13 Comparison of Drive Pulse Length in Acceleration / Deceleration
9
MCX314
nThe Accuracy of Drive Speed
The clock(SCLK) running in MCX14 is half of external input clock(CLK). If CLK input is standard 16MHz, SCLK will be 8MHz. Therefore, the user had better driving the pulse speed in a exact multiple of SCLK period(125nSEC). Otherwise, the driving pulse will not very stable. The following table shows the frequency (speed) of driving pulse of MCX314 can be, there are all exact the multiple of 125nSEC. Multiple Drive Speed (PPS) 2 3 4 www..com 5 6 7 8 9 10 4.000 M 2.667 M 2.000 M 1.600 M 1.333 M 1.143 M 1.000 M 889 K 880K Multiple 11 12 13 14 15 16 17 18 19 20 Drive Speed (PPS) 727 K 667 K 615 K 571 K 533 K 500 K 471 K 444 K 421 K 400 K Multiple 95 96 97 98 99 100 101 102 103 104 Drive Speed (PPS) 84,211 83,333 82,474 81,632 80,808 80,000 79,208 78,431 77,670 76,923 Multiple 995 996 997 998 999 1000 1001 1002 1003 1004 Drive Speed (PPS) 8040 8032 8024 8016 8008 8000 7992 7984 7976 7968
As shown in the table above, it is not very stable to set any desired driving speed. However, MCX314 can make any drive speed in using the following method. When the preset range value: R= 80,000 (Multiple=100), drive speed setting value: V=4900, the output pulse is set 4900 x 100=490KPPS. From the able above, the output 490KPPS cannot be exactly made because the period of 490KPPS is 16.326 times of SCLK (125nSEC). Therefore, as shown in Figure 2.14, MCX314 combines 16 times and 17 times of SCLK period in a rate of 674:326 to generate an average 490KPPS.
16
16
16
17
16
16
17
Fig. 2.14 The driving pulse of 490KPPS when SCLK is 8MHz
According to this method, MCX314 can generate a constant speed driving pulse in a very high accuracy. In general, the higher of the driving speed, the lower of the accuracy. But for MCX314, it still can maintain relative accuracy when the driving speed is high. Actually, the accuracy of driving pulse is still within 0.1%. Using oscilloscope for observing the driving pulse, we can find the tolerance about 1SCLK(125nSEC). This is no matter when putting the driving to a motor because the tolerance will be absorbed by the inertia of motor system.
10
MCX314
2.3 Position Control
Fig 2.15 is 1-axis position control block diagram. For each axis, there are two 32 bit up-and-down counters for counting present positions and two comparison registers for comparing the present positions.
PP
UP
+direction pulse
PM -direction pulse W/R W/R
Logical Position Counter DOWN (32bit)
UP
Real Position Counter DOWN (32bit)
Waveform Transformation
ECA/PPIN encoder ECB/PMIN feedback pulse
www..com
Selector
WR2 Register/D5
Compare
W
COMP+ Register 32Bit COMP- Register 32Bit
RR1 register/D0 CMPP RR1 register/D1 CMPM
Compare
W
Fig. 2.15 Position Control Block Diagram
2.3.1 Logic Position Counter and Real position Counter
The logic position counter is counting the driving pulses in MCX314. When one + direction plus is outputting, the counter will count-up 1; when one - direction pulse is outputting, the counter will count-down 1. The real position counter will count input pulse numbers from external encoder. The type of input pulse can be either A/B quadrature pulse type or Up / Down pulse(CW/CCW) type (See Chapter 2.6.3). Host CPU can read or write these two counters any time. The counters are signed 32 bits, and the counting range is between -2,147,483,648 ~ + 2,147,483,647. The negative is in 2' s complement format. The counter value is random while resetting.
2.3.2 Compare Register and Software Limit
Each axis has, as shown in Fig, 2.15, two 32-bit registers which can compare the logical positions with the real positions. The logical position and real position counters are selected by bit D5 (CMPSL) of register WR2. The main function of COMP+ Register is to check out the upper limit of logical / real position counter. When the value in the logical / real position counters are larger than that of COMP+ Register, bit D0 (CMP+) of register RR1 will become 1. On the other hand, COMP- Register is used for the lower limit of logical / real position counter. When the value of logical / real position counter become smaller than hat of COMP+ Register, bit D1 (CMP-) of register RR1 will become 1. Fig. 2.16 is an example for COMP+ = 10000, COMP- = -10000.
RR1/D0=0 RR1/D1=1 CM RR1/D0=0 RR1/D1=0 CP RR1/D0=1 RR1/D1=0 COMP+ register CP=10000 COMP- register CM=-1000
-1000 0
10000
Fig. 2.16 Example of COMP+/- Register Setting
COMP+ and COMP- registers can be used as software +/- limit. When D0 and D1bits of register WR2 are set to 1, it enables the software limit. In driving, if the value of logical / real counter is larger than COMP+, the decelerating stop will be performed, and D0 (SLMT+) of register RR2 will change to 1. If the value of logical / actual counter is smaller than that of COMP+, the D0 bit of register RR2 will change to 0 automatically. Host CPU can write the COMP+ and COMP- registers any time. However, when MCX314 is reset, the register values are random.
11
MCX314
2.4 Interpolation
This 4-axis motion control IC can perform any 2 / 3 axes linear interpolation, any 2 axes circular interpolation and any 2 / 3 axes bit pattern interpolation. Bits D0, D1 (ax 1), D2, D3 (ax 2) and D4, D5 (ax 3) of register WR5 can be pointed for performing the interpolation. In the process of interpolation driving, all the calculations will follow the main axis (ax1). So, the user has to set the parameters such as initial speed and drive speed of the main axis before performing the interpolation. During the linear interpolation, it is not necessary to set the main axis as " long axis" . After setting all of the parameters for interpolations, and writing the interpolation driving commands to command register WR0, the user can start the interpolation driving. During the interpolation driving, D8 (IDRV) of main status register RR0 will become 1 during the interpolation, and it will become 0 when the interpolation is finished. Also, during the interpolation driving, the bit n-DRV of the interpolating axis will become 1. The maximum drive speed is 4MPPS for linear, circular or bit pattern interpolation. For continuous interpolation, the maximum drive speed is 2MPPS. www..com Over Limit Error of Interpolation When the hardware limit or the software limit of each axis is active during the interpolation driving, the interpolation will stop. It the stop is occurred by errors, RR0 (main status register) will confirm the error bit of the designated interpolating axis. PR0 will become 1, and RR2 (error register) of this axis will be read out. Note: In case of circular or bit patter interpolation, the " active" of hardware or software limit, in either + or direction, will stop the interpolation driving. In-position Signal for Servo Motor During the interpolation driving, when the in-position signal (nINP0S) of each driving axis is active, and also when the interpolation is finished, the INP0S signal of the axis is stand-by at its active level, and D8 (I-DRV) of RR0 register returns to 0.
2.4.1 Linear Interpolation
Any 2 or 3 axes of the 4 axes can be set for linear interpolation. To execute the linear interpolation, the user can, according to the present point coordinates, set the finish point coordinates and the interpolation command(s) for 2 or 3 axes. As shows in Fig. 2.17 the proceeding for linear interpolation is performing from the start point to the finish point. For individual axis control, the command pulse number is unsigned, and it is controlled by + direction command or - direction command. For interpolation control, the command pulse number is signed. The resolution of linear interpolation is within 0.5 LSB, as showen in Fig. 2.17. As shown in Fig. 2.18, it is an example for pulse output of the linear interpolation driving. We define the longest distance movement in interpolation is the " long axis" . And the other is " short axis" . The long axis outputs an average pulse train. The driving pulse of the short axis depends on the long axis and the relationship of the two axes. The range for each axis is a 24-bit signed counter, from -8,388,607 ~ +8,386,807. Note: The user cannot set -8,388,608.
Y Short axis 10 (20,9)
5 0.5LSB
0
20 X Long axis Fig. 2.17 The Position Accuracy for Linear Interpolation 5 10 15
Long axis XPP XPM Short axis YPP YPM Fig. 2.18 The Example for Pulse Output at Finish Point (X=20, Y=9)
12
MCX314
1/2 example of linear interpolation for 2 axes The
Executing linear interpolation drives in X and Y axes from the current position to the finish position ( X: +300, Y: -200). The interpolation drive speed is constant: 1000PPS.
WR5 axis WR6 WR7 WR0 WR6 WR0 WR6 www..com WR0 WR6 WR7 WR0 WR6 WR7 WR0 WR0 0004h 1200h 007Ah 0100h 03E8h 0104h 03E8h 0105h 012Ch 0000h 0106h FF38h 0000h 0206h 0030h write ; map ax1 to X axis, ax2 to Y
Y 0 100 200 300 X
write write write write write write write write write write write write write write
; range: 8,000,000 (Multiple = 1)
-100
; initial speed :1,000PPS
-200
; drive speed: 1,000PPS
(300,-200)
; finish point of X axis: 300
; finish point of Y axis: -200
; linear interpolation driving for 2 axes enabling
1/2 example of linear interpolation for 3 axes The
Executing linear interpolation drive for X, Y and Z axes from the current position to the finish position ( X: 15,000, Y: 16,000, Z: 20,000). The initial speed = 500PPS, acceleration / deceleration = 40,000PPS/SEC, drive speed = 5,000PPS.
WR5 WR6 WR7 WR0 WR6 WR0 WR6 WR0 WR6 WR0 WR6 WR7 WR0 WR6 WR7 WR0 WR6 WR7 WR0 WR0 WR0 0024h 1200h 007Ah 0100h 0140h 0102h 01F4h 0104h 1388h 0105h 3A98h 0000h 0106h 3E80h 0000h 0206h 4E20h 0000h 0406h 003Bh 0031h write write write write write write write write write write write write write write write write write write write write write ; define: ax1=X axis, ax2=Y axis, ax3= Z axis ; range: 8,000,000 (Multiple = 1)
Z Y 20,000
; accel./decel. speed: 40,000/SEC ; 40,000 / 125 / 1 = 320=140h ; initial speed : 500PPS
16,000
; drive speed : 5,000PPS
0 15,000
X
; finish point of X axis:15,000
; finish point of Y axis:; -16,000
; finish point of Z axis; 20,000
; deceleration enabling ; linear interpolation driving for 3 axes enabling
13
MCX314
2.4.2 Circular Interpolation
Any 2 axes of the 4 axes can be selected for circular ax2 interpolation. CCW circular interpolation The circular interpolation is starting from the current position (start point). After setting the center point of circular, the finish position and the CW or CCW direction, the user can start the circular interpolation. Start point Note: The coordinates setting value is the relative value of the Finish point Center point ax1 start point coordinates. Finish point Start point In Fig. 2.19, it explains the definition of CW and CCW circular interpolations. The CW circular interpolation is starting from the start point to the finish position with a clockwise direction; the CCW circular interpolation is with a counter-clockwise direction. CW circular interpolation When the finish point is set to (0, 0), a circle will come out. www..com Fig. 2.19 CW/CCW Circular Interpolation In Fig. 2.20, it explains the long axis and the short axis. First, we define 8 quadrants in the X-Y plane and put the numbers 0~7 to each quadrant. We find the absolute value of ax1 is always larger than that of ax2 in quadrants 0, 3, 4 and 7, so we call ax1 is the long axis (ax2 is the short axis) in these quadrants; in quadrants 1, 2, 5 and 6, ax2 is the long axis (ax1 is the short axis). The short axis will output pulses regularly, and the long axis will output pulses depending on the interpolation calculation. In Fig. 2.21, it is an example to generate a circle with the center point (-11,0) and the finish point (0,0). Its radium is 11. In Fig. 2.22 shows the pulse output.
:start point/finish point
ax2 ax1 ax1 2 ax2 ax2 3 4 5 6 1 0 7 (ax1,ax2) ax2 ax2 ax1 3 4 5 2
Y
Y :track of interpolation solid line : circle with radium 11 dash line : circle with radium 11O 1
1 0 X 7 6
ax1 ax1
Fig. 2.20 The 0~7Quadrants And Short Axes in Circular Interpolation Calculation
Fig. 2.21 The Example of Circular Interpolation
XPP XPM YPP YPM Quadrant 0 1 2 3 4 5 6 7
Fig. 2.22 The Example of Pulse Output in Circular Interpolation Driving
14
MCX314 1/2 Finish Point Checking of Circular Interpolation The In the circular interpolation, it assumes that the current position (start point) is (0,0). After the coordinates of the center point is set, the radium will be decided, and the circular tracking will start. The maximum error range of interpolation is with in O 1LSB. Because of the O 1LSB error range, the designated finish point may not on the circular track. The IC will make an inposition checking by the short axis. If the value of finish point is as same as that of short axis, this circular interpolation is finished. Fig. 2.23 shows an example of CCW interpolation with the start point (0,0), center point (-200,500) and finish point (702, 299). The finish point is in quadrant 4, and ax2 is the short www..com axis in quadrant 4. So the interpolation is finished when the ax2 is 299. The range of interpolation coordinate is from the start point to -8,388,608 ~ +8,388,607, and the interpolation error for all the range is within O 1LSB. The speed of interpolation driving is 1PPS ~ 4MPPS.
ax2
2 3
1 0
Center point (-200,500)
ax1
4
Finish point (-720,299)
7 5 6
Start point (0,0)
Interpolation will be finished when ax2=299 in the 4th quadrant
Fig. 2.23 Example of In-position Check in Circular Interpolation
1/2 Example for CW Circular Interpolation The
This CW circular interpolation starts from the current point (start point: 0, 0) to the finish point ( X: 5000, Y: 5000); the center point is X: 5000, Y: 0. The interpolating speed is constant at 1000PPS in a constant vector speed driving.
WR5 WR6 WR7 WR0 WR6 WR7 WR0 WR0 WR0 WR6 WR0 WR6 WR7 WR0 WR6 WR7 WR0 WR6 WR7 WR0 WR6 WR7 WR0 WR0 0104h 0900h 003Dh 0100h write write write write ; define: ax1:X axis, ax2:Y axis, and with constant linear speed ; range : 4,000,000 (multiple: 2)
Y
4DC0h write 0056h write 0200h write 01F4h 0104h 01F4h 0105h 1388h 0000h 0108h 0000h 0000h 0208h 1388h 0000h 0106h write write write write write write write write write write write write write
; range of constant vector speed for 2 axes ; 4,000,000 x 1.414 = 5,656,000 ; initial speed : 500 x 2 = 1000PPS
Start point (0,0) Center point(5000,0)
X
; drive speed : 500 x 2 = 1000PPS ; center point of X :5,000
End point (5000,-5000)
; center point of Y :0
Fig. EX.2 CW Circular Interpolation in Constant Vector Speed
; finish point of X :5,000
EC78h write FFFFh write 0206h write 0032h write
; finish point of Y :-5,000
; CW circular interpolation enabling
15
MCX314
2.4.3 The Bit Pattern Interpolation
MCX314 is able to receive the interpolation data from 40 the host CPU, and output pulses at a specific speed. The host CPU executes the interpolation for 2 or 3 axes, 24 generates a set of pulse data, then writes the commands into MCX314. MCX314 will output the 16 pulses at a specific speed. 48 Every axis has 2 bit-data buffers for host CPU: one for 32 + direction and the other for - direction. When performing the bit pattern interpolation, the host CPU 8 will write the designated interpolation data, for 2 or 3 0 56 axes, into MCX314. 62 X If a bit in the bit pattern data from CPU is " 1" , MCX314 will output a pulse at the time unit; if it is " 0" , MCX314 Fig. 2.24 Example for Bit Pattern Interpolation www..com not output any pulse at the time unit. will For example, if the user want to generate the X-Y profile (see Fig. 2.24), the host CPU must write a set of pattern into those specific registers ---- XPP: the + direction register for X axis, XPM: the - direction register for X axis, YPP and YPM: the + and - directions registers. With in the time unit, MCX314 will check the registers once and decide to output a pulse or not depending on the bit pattern.
56 01000000 01111111 00000000 00001010 48 00000000 11110101 00000000 11111111 40 32 00011111 11011011 00000000 00000000 00000000 11111111 11111100 00000000 24 11110110 00000000 00000000 00111111 16 11111110 00000000 00001111 11000000 8 00000000 00101011 11111111 00000000 0 00000000 11111111 11010100 00000000
: XPP (X + direction) : XPM (X -direction ) : YPP (Y + direction) : YPM (Y - direction)
Fig. 2.25 is the block diagram of bit pattern interpolation for the 1st axis in MCX314. BP1P register and BP1M register are 16 bit-data buffers for bit pattern data form the host CPU. (IF the system uses 8-bit data bus, the host CPU has to write the data by low byte and high byte.) The + direction data should be written into PB1P, and the - direction data into PB1M. Once starting the bit pattern interpolation, the pulse outputting is in the order from D0.
SC=2 BP1P Sys. CPU 0100000000100001 REG2 0000100000000100 1 REG1 0001001000010000 D0 0 D15 1001101001110101 SREG REG2 0100000100001010 BP1M Sys. CPU 0000011100001010 1 REG1 1000010000100000 D0 0 D15 0000000000001010 SREG SC 0~3 0 0 0 1010 ax1-PM 1 1 10101 ax1-PP
SC=2
SC: Stack counter (RR0/D14,13) BP1P: Data register (ax1 + direction) BP1M: Data register (ax1 - direction) SREG: 16 bit shift register REG1: 16 bit buffer register 1 REG2:16 bit buffer register 2
Fig. 2.25 The Structure of Register for The Bit Pattern Interpolation ( for 1 axis) Stacking counter (SC) is a 2-bit counter. Its value is between 0 and 3, which can be read from D14,13 of register RR0. SC will decide which register for the data from the host CPU. The initial value of SC is 0. So, 16
MCX314 when host CPU writes bit pattern data into BP1P or BP1M, the data will be stored in SREG, and then, SC will count up to 1, and the next data from the host CPU will be written into REG1. By this way, the REG2 becomes the register when SC=2. The host CPU is not able to write any bit pattern data into MCX314 when SC=3. When the bit pattern interpolation pulse is outputting, D0 in SREG will be shifted output first, and then in the order of D1, D... When all of SREGs have been shifted output, the data in REG1 will be shifted to SREG, the data in REG2 will be shifted to REG1, and the SC will count down to 2. Then, the host CPU is able to write a new data into MCX314 again. In order to make MCX314 output the bit pattern data continuously, the host CPU should write the data into MCX314 before SC counts down to 0. MCX314 will output a interrupt requirement signal to host CPU when SC counts down from 2 to 1.
1/2 limitation for the speed of bit pattern interpolation driving The
The maximum pulse output speed of MCX314 is 4MHz in bit pattern interpolation mode. However, the maximum speed will depend on the data update rate of host CPU if the bit pattern data are more than www..com 48bits. For example of the X and Y axes bit pattern interpolation, if the host CPU needs 100usec to update new 16-bit data for X and Y axes. The maximum speed is 16/100SEC=160KPPS.
1/2 ending of bit pattern interpolation The
There are 2 ways can terminate the bit pattern interpolation. * Write a ending code into buffer register of ax1. The bit pattern interpolation mode will be finished, and stopped if the host CPU write " 1" into both + and - directions buffer registers. D15 BP1P D0
0000011110100000
BP1M
0000010000001111
The Interpolation Stops Once The + And - Directions Are "1".
When the ending code is executed, the SC will become 0 automatically. The host CPU stops writing any command into MCX314. When SC=0, and when no other data is updated, MCX314 will stop outputting pulse. Then, the bit pattern interpolation is finished.
1/2 Utilizing the stop command to pause the interpolation
The interpolation driving will be paused if a sudden stop or decelerating stop command is written into the master axis (ax1) which is executing the bit pattern interpolation. MCX314 will continue the bit pattern interpolation if the host CPU enables the bit pattern interpolation again. If the host CPU wants to finish the interpolation after writing stop command, all of the interpolation bit data in MCX314 must be cleared in using BP register (3Dh).
1/2 Utilizing hardware limit to interrupt the interpolation
The interpolation driving will be terminated when any hardware limit of any axis is active. And, if host CPU wants to finish the interpolation, all of the interpolation data in MCX314 must be cleared.
17
MCX314
1/2riting the bit pattern data into the register in MCX314 W
Either by 16-bit data bus or by 8-bit data bus, the address map of the command buffer for bit pattern interpolation data is show as follows: The addresses map of register for 16-bit data bus in bit pattern interpolation Address A2 0 0 0 0 1
www..com
A1 0 0 1 1 0 0 1 1
A0 0 1 0 1 0 1 0 1
Name of register
Content
The register with the same address WR0 nWR1
BP1P BP1M BP2P BP2M BP3P BP3M
ax1 +direction data ax1 -direction data ax2 +direction data ax2 -direction data ax3 +direction data ax3 -direction data
nWR2 nWR3 WR4 WR5 WR6 WR7
1 1 1
Note: BP3P and BP3M share the same registers: WR6 and 7. The addresses map of register for 8-bit data bus in bit pattern interpolation Address A3 0 0 0 0 0 0 0 0 A2 0 0 0 0 1 1 1 1 A1 0 0 1 1 0 0 1 1 A0 0 1 0 1 0 1 0 1 BP1PL BP1PH BP1ML BP1MH Name of register Address A3 1 1 1 1 1 1 1 1 A2 0 0 0 0 1 1 1 1 A1 0 0 1 1 0 0 1 1 A0 0 1 0 1 0 1 0 1 Name of register BP2PL BP2PH BP2ML BP2MH BP3PL BP3PH BP3ML BP3MH
Note: BPmPL, BPmPH, BPmML, BPmMH represent the following bit groups (m is 1 ~ 3 ). BPmPL : the low byte of BPmP (D7 ~ D0) BPmPH : the high byte of BPmP (D15 ~ D8) BPmML : the low byte of BPmM (D7 ~ D0) BPmMH : the high byte of BPmM (D15 ~ D8) For some addresses of bit pattern data registers are as same as nWR2 ~ nWR7, the host CPU can not write any data into the bit pattern data register since MCX314 has been reset. To write the bit pattern command, the host CPU should be with the following sequence. Write bit pattern(BP) enable command(36h) into command register Write bit pattern data Write BP disable command(37h) into command register Note : If the host CPU doesn' t disable the BP data register, the data in nWR2 ~ nWR5 registers cannot be assessed.
1/2 example of bit pattern interpolation The
The bit interpolation example is shown in Fig. 2.24. We set X axis as ax1, Y axis as ax2 and a constant 18
MCX314 speed: 1000PPS in a constant vector speed interpolation driving.
WR5 WR6 WR7 WR0 WR6 WR7 WR0 WR6 WR0 WR6 WR0 WR0 WR0 0104h 0900h 003Dh 0100h 4DC0h 0056h 0200h 01F4h 0104h 01F4h 0105h 0039h 0036h ;Define ax1: X , ax2:Y ;setting the master axis speed parameter write ;range: 4,000,000 (multiple rate:2) write write write write write write write write write write ;range of constant line speed ;4,000,000x1.414=5,656,000 ;Initial speed:500x2=1000PPS ;drive speed: 500x2=1000PPS J1 ;clear BP data ;enable to write into BP register ; command of bit 0~15th 0000h 2BFFh FFD4h 0000h 0038h write write write write write ;X axis +direction command ;X axis -direction command ;Y axis +direction command ;Y axis -direction command ;BP data stacking, SC=1 ; command of bit 16~31th BP1P BP1M BP2P F6FEhwrite ;X axis +direction command 0000h write ;X axis -direction command 000Fh write ;Y axis +direction command J2 BP1P BP1M BP2P BP2M WR0 WR0 4000h 7FF5h 0000h 0AFFh 0038h write write write write write write read RR0/D14,13 read If D14=D13=1 Jump to J1 write write BP2M 3FC0h WR0 0038h write write ;Y axis -direction command ;BP data stacking, SC=2 ; command of bit 32~47th BP1P BP1M BP2P BP2M WR0 WR0 1FDBh 0000h 00FFh FC00h 0038h write write write write write write ;X axis +direction command ;X axis -direction command ;Y axis +direction command ;Y axis -direction command ;BP data stacking, SC=3 ;enable 2 axis bit pattern ;interpolation, because SC=3 ;until the SC is less than 2 ; command of bit 48~63th ;X axis +direction command ;X axis -direction command ;Y axis +direction command ;Y axis -direction command ;BP data stacking, SC=3 ;disable to write into BP register ;until ending interpolation drive
0034h
www..com
BP1P BP1M BP2P BP2M WR0
0037h
RR0/D8 If D8=1 Jump to J2
(Note 1: If there is more BP data coming then repeat this process)
1/2 Executing bit pattern interpolation by interrupt
During the bit pattern interpolation, MCX314 will generate an interrupt request signal to the host CPU while SC changes the value from 2 to 1. To enable the interrupt, the host CPU must set D15 of register WR5 to 1. Then, INTN of MCX314 will go low once SC changes the value from 2 to 1. The host CPU will check the SC value, and write bit pattern command into the register. The interrupt signal will be released if the host CPU writes the SC stacking command(38h) into MCX314. The interrupt signal will be released when the clear command(3dh) is written into the command register. If the interrupt status is keeping on the Low level, it will return to high-Z level after MCX314 finishes the bit pattern interpolation.
2.4.4 Constant Vector Speed
MCX314 is with the constant vector speed control function which can control the resultant speed of two axes to keep the speed in constant. Fig. 2.26 shows the profile of 2 axes interpolation driving. The vector speed reflects 1.414 times of the individual axis driving speed. So, we have to set the speed of 1.414 times to keep the vector speed for 2-axis driving.
Y
X
1/2 Constant Vector Speed Set-up
The user should first set the values of D9 and D8 of register WR5to 0 and 1.Then, set the range R of salve-axis (ax2) to be 1.414 times of the value of the master-axis (ax1). Therefore, MCX314 will use the range parameter of master-axis if only 1 axis outputs pulses. However, when 2 axes output pulses simultaneously, MCX314 will use the range parameter of slave-axis to implement the pulse period to 1.414 times.
Fig. 2.26 Example of 2 axis interpolation
1/2 Example of Constant Vector Speed Interpolation for 2 Axes The
As shown below, the master-axis (ax1) = X axis, the slave-axis (ax2) = Y axis, and the interpolation is at a constant vector speed: 1000PPS. The result of driving pulse output is shown in Fig. 2.27.
19
Note1
MCX314
WR5 0104h WR6 0900h WR7 003Dh WR0 0100h WR6 4DC0h WR7 0056h WR0 0200h WR6 01F4h WR0 0104h WR6 01F4h write write write write write write write write write write ; define ax1: X axis, ax2:Y axis ; constant vector speed ; setting parameter of the master axis ; range: 4,000,000 (multiple=2) ; range of 2-axis constant vector speed ; 4,000,000x1.414=5,656,000 ; initial speed: 500x2=1000PPS ; drive speed: 500x2=1000PPS WR0 0105h WR6 03E8h WR7 0000h WR0 0106h WR6 0190h WR7 0000h WR0 0206h WR0 0030h write write write write write write write write ; finish point of X ; ; finish point of Y ; ; 2-axis linear interpolation starting
www..com
1.000ms XPP XPM YPP YPM
1.414ms
1.000ms
1.414ms
Fig. 2.27 The Example of 2-axis Interpolation at A Constant Vector Speed (speed=1000PPS)
1/2 Setting Constant Vector Speed for 3 Axes
As same as the setting process of 2 axes, the user should first set the values of D9 and D8 of register WR5 to 0 and 1. Then, set the range R of ax2 to 1.414 times of the value of the master-axis (ax1); then, set the range R of ax3 to 1.732 times of the value of the master axis. After setting the range of constant vector speed for 3 axes, MCX314 will use the range parameter of ax1 if only 1 axis outputs pulses. However, when 2 or 3 axes output pulses simultaneously, MCX314 will use the range parameter of ax2 or ax3 to implement the pulse period. See Fig. 2.28. User may set the values of D9 and D8 of register WR5 to 0 and 1 for 2-axis constant vector speed driving even in the 3-axis interpolation.
1.000ms XPP XPM YPP YPM ZPP ZPM 1.414ms 1.000ms 1.732ms 1.414ms
Fig. 2.28 Example for 3-axis Interpolation at A Constant Vector Speed (speed=1000PPS)
Caution: In the process of constant vector speed, the pulse width of high level of output waveform will not be changed, yet kept in the same width. The pulse cycle will be changed to 1.414 or 1.732 times.
20
MCX314
2.4.5 Continuous Interpolation
The continuous interpolation is executing a series of interpolation processes such as linear interpolation / circular interpolation / linear interpolation ...During the continuous interpolation, the driving will not stop; contrarily, The pulses are outputcontinuously. When executing the continuous interpolation, the host CPU has to write the next interpolation command into MCX314 before the previous interpolation command is finished.
The 1 node data write in interpolation cmd. write in
st
errors occurred?
yes
1/2 Continuous Interpolation in Using D9 of RR0
If D9 (CNEXT) of register RR0 is 1, MCX314 is ready to accept the next interpolation command. If D9 is 0, the host CPU is not able to write the next interpolation command into MCX314. The D9 will become 1 only when the present command is executed. MCX314 will not accept the next command, and the www..com D9 is 0 if the present command has not been executed. So, the standard procedure of continuous interpolation is first to write, and enable the interpolation data and command, then check if D9 of RR0 is 1 or 0. And then, repeat writing commands and checking D9. The flow chart is shown at the right side.
no
allow to write in the next data? RR0/D9=1?
The 2 node data write in interpolation cmd. write in
nd
errors occurred?
yes
1/2 Interrupt
D14 of register WR5 is used for enable or disable the interrupt during the continuous interpolation. After setting D14 of register WR5 to 1, the interrupt occurs. Pin INTN of MCX314 will be on the Low level to interrupt the host CPU when D9 of register RR0 become 1. The INTN will be on the Hi level if the host CPU writes the next interpolation command to MCX314. If the interrupt clear command (3Dh) is written to command register, the INTN signal will return to high-Z level from the Low level. During the ending of the interpolation, it is forced to be " interrupt disable" , and the INTN signal will return to the high-Z level.
no allow to write in the next data? RR0/D9=1? Ending the interpolation drive Processing the errors
rd
The 3 node data write in interpolation cmd. write in
1/2 Errors Occurring in the Process of Continuous Interpolation
If an error such as over-traveling occurs in the process of continuous interpolation, the drive will stop at the present interpolation node. The following interpolation command is still in the command register, but will not be executed. The host CPU has to reload the next command again and enable it. As shown in the flow chart above, the host CPU has to check the error message before loading the following command. If not, this command will not be executed and will be jumped. So, the user should assure, and check if any error status will occur before the following interpolation command is loaded.
1/2 Attentions for Continuous Interpolation
l Before setting the interpolation command, the user should first set other data such as center point, finish point... each node. for l The maximum speed for the continuous interpolation is 2MHz. l The following interpolation command must be loaded before the previous interpolation command is finished. l The node driving time should be longer than the time for error checking and the command setting of next node during the interpolation. l It is impossible to operate 2-axis and 3-axis continuous interpolations at the same time. l It is not allowed to change the axis assignment during the process of continuous interpolation.
21
MCX314
1/2 Example of Continuous Interpolation The
Fig. 2.29 shows an example of executing continuous interpolation beginning at point (0,0) from node 1, 2, 3... the node 8. In node 1, 3, 5, and 7, the linear interpolation will be executed; in node 2, 4, 6, and 8, the .to circular interpolation will be executed, and the track is a quadrant circle with radius 1500. The interpolation driving is at a constant vector speed: 1000PPS.
WR5 0104h write ; define ax1: X axis , ax2: Y axis, constant vector speed ; setting the parameter of master axis ; range:4,000,000 (multiple: 2) ; 2-axis constant vector speed ; 4,000,000x1.414=5,656,000 ; Initial speed: 500x2=1000PPS ; drive speed: 500x2=1000PPS ; finish point X: 4500
WR6 0900h write WR7 003Dh write WR0 0100h write WR6 4DC0h write WR7 0056h write WR0 0200h write
www..com
4500 node5 node6 3000 node7 1500 node8 node1 -1500 (0,0) 4500 6000 node2 node3 node4
WR6 01F4h WR0 0104h WR6 01F4h WR0 0105h WR6 1194h WR7 0000h WR0 0106h WR6 0000h WR7 0000h WR0 0206h WR0 0030h J1
write write write write write write write write write write write
; finish point Y: 0
Node1
; 2-axis linear interpolation enabling
RR0(D4, D5) read ; if error occurs If D4 or D5=1 Jump to Error; jump to handle error RR0(D9) read If D9=0 Jump to J1 WR6 0000h WR7 0000h WR0 0108h write write write ; waiting for next node' s enable signal ; ; center X: 0
A
WR6 05DCh write WR7 0000h write WR0 0208h write WR6 05DCh write WR7 0000h write WR0 0106h write WR6 05DCh write WR7 0000h write WR0 0206h write WR0 0033h write
; center Y: 1500
; finish point X:1500
Node2
; finish point Y:1500
; CCW circular interpolation enabling
Procedure A WR6 0000h WR7 0000h WR0 0106h write write write ; finish point X: 0
WR6 05DCh write WR7 0000h write WR0 0206h write WR0 0030h write
; finish point Y: 1500
Node3
; 2-axis linear interpolation enabling
Procedure A ... ...
22
MCX314
(same procedure for nodes 4 ~ 8.)
www..com
23
MCX314
2.4.6 The Acceleration / Deceleration Control in Interpolation
Different from other IC chips only allowing constant speed for executing the interpolations, MCX314 supports the user to use trapezoidal and S-curve driving ( for linear interpolation only ). In the process of interpolation, for executing acceleration / deceleration in continuous interpolation process, the user can enable the deceleration by command (3Bh), or disable deceleration by command (3Ch). The purpose for the deceleration command is to enable the automatic deceleration or manual deceleration function; the purpose of the disable deceleration command is to disable both of them. It will be disable while power-on reset. During the driving, the deceleration enable command cannot be executed.
1/2 Acceleration / Deceleration for 2-axis / 3-axis Interpolation The
It is possible to perform trapezoidal and S-curve acceleration/deceleration driving during the execution of 2-axis / 3-axis linear interpolation. Either automatic or manual deceleration can be used for decelerating. When the manual deceleration is executed, the user can set the maximum absolute value of the axes to be www..com setting value of master axis decelerating point. For instance, while executing 3-axis linear interpolation the of master axis (ax1): X, ax2 : Y and ax3 : Z, the finish point : (X: -20000, Y: 30000, Z: -50000), and the assumed pulse numbers needed for deceleration are 5000. In such situation, the absolute value of Z axis is the largest, so we can set up 50000-5000=45000 to be the manual deceleration point of the master axis: X. Please refer to the example of 3-axis linear interpolation in 2.4.1.
24
MCX314
1/2 Acceleration / Deceleration for Circular Interpolation and Bit Pattern Interpolation The
In circular interpolation and bit pattern interpolation, only manual deceleration in trapezoidal driving is available; the automatic deceleration in S-curve driving is not available. The Figure on the right side shows the circular interpolation of a real circle with radius 1000 in a trapezoidal driving. The user should calculate the decelerating point before driving because the automatic deceleration will not be active. In the figure, the circle tracks through all the 8 quadrants: 0~7. In quadrant 0, Y axis is the short axis and it' s displace is about 10000 / O 2=7071 The total output pulses numbers of the short axis are 7010x8=56568. Furthermore, if the initial speed is 500PPS, and will be accelerated to 20KPPS after 0.3 SEC, the acceleration will be (20000-500) /0.3 = www..com 65000PPS/SEC. And the output pulses during acceleration will be (500+20000) x 0.3/2=3075. Thus, if we set the deceleration as same as the acceleration, the manual decelerating point will be 565683075=53493. Note: this formula cannot be used in the constant vector speed driving.
WR3 WR5 WR6 WR7 WR0 WR6 WR0 WR6 WR0 WR6 WR0 WR6 WR7 WR0 WR6 WR7 WR0 WR6 WR7 WR0 WR6 WR7 WR0 WR6 WR7 WR0 WR0 WR0 0001hwrite 0004hwrite 8480hwrite 001Eh write 0100hwrite 0082hwrite 0102hwrite 007Dh write 0104hwrite 1388hwrite 0105hwrite D8F0h write FFFFh write 0108hwrite 0000hwrite 0000hwrite 0208hwrite 0000hwrite 0000hwrite 0106hwrite 0000hwrite 0000hwrite 0206hwrite D0F5h write 0000hwrite 0107hwrite 003Bh write 0033hwrite ; manual deceleration enabling ; define ax1: X , ax2: Y ; range: 2,000,000; (multiple: 4) ; ; acceleration : ; 130x125x4=65000 PPS/SEC ; Initial speed:125x4=500PPS ; drive speed: 5000x4=20000PPS ; center point X : -10000 ; ; center point Y : 0 ; ; finish point X : 0 ; ; finish point Y : 0 ; ; manual deceleration point setting : 53493 ; ; deceleration enabling ; CCW circular interpolation starting
2
Y
1 0
3
10000 Short Axis
7071
X
4
7
5 Speed PPS 20k
6
Output Pulse During Acceleration
500 0.3 Time(sec)
25
MCX314
1/2 Acceleration / Deceleration for Continuous Interpolation The
In continuous interpolation, same as in circular and bit pattern interpolations, only manual deceleration in the trapezoidal driving is available; The automatic deceleration in S-curve driving is not available. Before performing the continuous interpolation, it is necessary to preset the manual decelerating point; however, this setting point is related to the master axis executing the deceleration in the last node. The user should disable the deceleration, then start the interpolation driving. Before writing the interpolation command to the final node which will execute the deceleration, the user should enable the deceleration at first. The deceleration will start if the output pulses are larger than the master axis based pulses in the final node. For instance, there are 5 interpolation nodes in the process of continuous interpolation. In case, the manual deceleration has to be executed in the last node, node 5, the procedure is shown as follows: Setting mode, acceleration / deceleration for master axis
www..com
Writing manual deceleration point Deceleration disabling (command: 3Ch) Writing node 1 data, interpolation command Error checking, waiting for the allowance to write the next data Writing node 2 data, interpolation command . . . Error checking, waiting for the allowance to write in the next data Deceleration enabling (command: 3Bh) Writing node 5 data, interpolation command :Starting continuous interpolation driving
manual deceleration point is related to the master axis' driving pulses which comes from node 5. The For instance, assumed that it needs 2000 pulses for decelerating stop, and the total amount of pulse output form node 5 is 5000. So, the manual deceleration point will be 5000 - 2000 = 3000. cycle of deceleration should be started and finished within the same node. The
26
MCX314
2.4.6 Single-step interpolation (from Command or External Signal)
Single-step is defined as: pulse by pulse outputting. Either command or external signal can execute the single-step interpolation. When one pulse is outputting, the master axis interpolation will be set in the constant speed driving. The Hi level width of each axis' s output pulse is 1/2 of the pulse cycle which is decided by the interpolating master axis' s drive speed. The Low level width is kept until next command or external signal comes. Fig. 2.30 is the example showing the execution of single-step interpolation from an external signal. The master axis' s initial speed is 500PPS, the drive speed is at 500PPS constant speed driving. The Hi level width of output pulse is 1msec.
ExPLSN
1 mSEC
www..com
XPP YPM
Fig. 2.30 Example of single step interpolation (500PPS) by external signal(EXPLSN)
1/2 Command Controlled Single-step Interpolation
The command: 3Ah is for single-step interpolation. The user can set D12 of register WR5 to 1 to enable the command controlled single-step interpolation. The operating procedure is shown as follow. * Set D12 of register WR5 to 1. It will enable the command controlled single-step interpolation. Set the initial and drive speeds of the master axis in the interpolation process with the same value, and the driving becomes constant speed. If the host CPU writes single step command into MCX314 at most 1 mSEC, the user should set the drive speed more than 1000PPS. Set interpolation data. (start point, center point... ) Write interpolation command. Although the interpolation command is enabled, there is no pulse output because the single-step is command controlled. ... Write the single-step interpolation command (3Ah). The driving pulses according to the interpolation calculation will be output for each axis. The user may use command 3Ah for single step until the interpolation driving is finished. If the user wants to stop sending single-steps during the interpolation, he can use the sudden stop command (27h), then wait for more than 1 pulse cycle, and then write the command (3Ah) again to stop the driving. After this, all the following (3Ah) commands will not be active.
1/2 External Signal Controlled Single-step Interpolation
The EXPLSN pin ( 29) is used for the single-step interpolation from the external signal. The user can set D11 of register WR5 to 1 to enable the external signal controlled single-step interpolation. Normally, the EXPLSN input signal is on the Hi level. When it changes to Low, the interpolation step will be output. The operating procedure is shown as follows. * Set D11 of register WR5 to 1. It will enable the external signal controlled single-step interpolation. Set the initial and driving speeds of the master axis in the interpolation process to be the same value, and the driving becomes constant speed which should be higher than the Low pulse cycle of EXPLSN. This is necessary for this controlled mode. And it will set the MCX314 into a constant speed mode. Set interpolation data. (starting point, center point... ) Write interpolation command. Although the interpolation command is enabled, there is no pulse output because the single-step is command controlled. ... EXPLSN input on Low level The interpolation pulse will be output from each axis after 2~5 CLK the pulse falling down. The Low level pulse width of EXPLSN has to be longer than 4CLK. Furthermore, the pulse cycle of EXPLSN has to be longer than the setting speed cycle of master axis. The user may repeat the Low level of EXPLSN before the interpolation is finished.
27
MCX314 If the user wants to stop sending single-steps during the interpolation, he can use the sudden stop command (27h), then wait for more than 1 pulse cycle, and then input pulse on EXPLSN Low level again to stop the driving (the user may try software reset also). After this, all the following input pulses on EXPLSN Low level will not be active. Note: When connecting the EXPLSN Low level with the manual connector, please assure the EXPLSN signal is not chattering.
2.5 Interrupt
The interrupt is generated from X, Y, Z, or U axis, bit pattern interpolation or continuous interpolation. There is only one interrupt signal, INTN (33), to the host CPU. So, the signal will be OR calculated, then output, as shown in Fig. 2.31.
X Axis
www..com
INT
YAxis
INT
Z Axis
INT
U Axis
INT
Interpolation control unit
INT
INTN(33)
Figure 2.31 Interrupt Signal Path in IC Every interrupt can be enabled or disabled individually. During the power resetting, all interrupt signals are disabled.
n Interrupt of X, Y, Z, and U Axes
The following table shows the interrupt factors generated by X, Y, Z, and U axes. Enable / Disable Status The Factors of Interrupt Happening nWR1 Register nRR3 Register D8(PULSE) D0(PULSE) when one pulse outputs... (The interrupt will be generated at the rising edge of pulse output for + direction driving.) once the value of logical / real position counter is larger than or equal D9(PC-) D1(PC-) to the value of COMP- register (CM)... D10(P28
MCX314
nInterrupt from Interpolations
Enable / Disable WR5 Register D14(CIINT) Status Check RR0 Register The Factors of Interrupt Happening *Interrupt Clearing
D15(BPINT)
in continuous interpolation, when MCX314 is available for the interpolation data of next node... D9(CNEXT) *after next interpolation command is written, the interrupt will be cleared. In bit pattern interpolation, when the value of stack connector (SC) is changed from 2 to 1, and the stack is available for next BP command D14,13(BPS1,0) writing... *after a BP command for the stack is written, the interrupt will be cleared.
www..com When
an interrupt is generated during interpolations, this interrupt can be cleared by writing the interrupt clear command (3Dh) INTN will return to the High-Z level automatically once the interpolation is finished.
2.6 Other Functions
2.6.1 Driving By External Pulses
Fixed pulse driving and continuous pulse driving can be controlled by either commands or external signals, which can reduce the load of host CPU. Each axis has two input signals, nEXPP and nEXPM. nEXPP controls + direction pulse output, and nEXPM controls - direction command. D3 and D4 bits of register WR3 are for the setting in driving. The user should preset the parameters and commands. The default level of nEXPP and nEXPM is normally set on Hi.
nFixed Pulse Driving Mode
Set bits D4 and D3 of register WR3 to 1 and 0 respectively, and set all the parameters of fixed pulse driving. Once nEXPP is falling down to the Low level ( othe + direction fixed pulse driving will start; once nEXPP ), is raising to the Hi level ( othe - direction fixed pulse driving will start. The width of Low level signal must ), be larger than 4 CLK-cycle. Before this driving is finished, a new Hi-to-Low level falling down of the signal is invalid.
XEXPP XEXPM XPP XPM
Fig. 2.32 Example of The Fixed Pulse Driving by External Signal
[Note] When connecting the input signal with a mechanical connector, the signal chattering would happen, especially if the output pulse numbers are few. Please add a de-bounce circuit to avoid the chattering.
nContinuous Pulse Driving Mode
Set bits D4 and D3 of WR3 register to be 1 and 0 respectively, and set all the parameters of continuous pulse driving. Once nEXPP is falling down to the Low level ( othe + direction continuous pulse driving ), will start; once nEXPP is raising to the Hi level ( othe - direction fixed pulse driving will start. When ), nEXPP returns to the Hi level from the Low level, the decelerating stop will be performed in trapezoidal driving, and the sudden stop in constant speed driving.
XEXPP XEXPM XPP XPM
Figure 2.33 Example of Continuous Driving by External Signal
Low period Low period
29
MCX314
2.6.2 Pulse Output Type Selection
There are two types of pulse output--independent 2-pulse type: when the driving is in + direction, the pulse output is from nPP/PLS; when the driving is in - direction, the pulse output is from nPM/DIR; 1-pulse 1direction type: nPP/PLS is for pulse outputting, and nPM/DIR is for direction signal outputting.
(pulse / direction is set on the positive logical level)
Pulse Output Type
Drive Direction +Direction
Pulse Output Waveform nPP/PLS Signal NPM/DIR Signal
Low level Low level Low level
Independent 2-pulse - Direction +Direction 1-pulse 1-direction
www..com
- Direction
Hi level
Bit D6 (PLSMD) of register WR2 is used for the selection of pulse output type. Additionally, bits D7 (PLS-L) and D8 (DIR-L) of register WR2can be used for pulse outputting, direction and logical level setting. [Note] Please refer to Chapter 13.2 and 13.3 for the pulse signal (nPLS) and direction signal (nDIR) in 1pulse 1-direction pulse outputting.
2.6.3 Pulse Input Type Selection
For real position counter, A/B quadrature pulse type and Up / Down pulse type can be selected for pulse input. When A/B quadrature pulse type is selected, the position counter will count up if phase A leads phase B; the position counter will count down if phase B leads phase A. The pulse cycle can be set 1/2 or 1/4.
nECA/ PPIN nECB/ PMIN Counting Up Counting Down
When Up / Down pulse type is selected, nECA/PPIN is used for count-up input, and ECB/PPIN for countdown input. The counting is during the + direction pulses are up ( o ).
nECA/ PPIN nECB/ PMIN Counting Up Counting Down
2.6.4 Hardware Limit Signals
Hardware limit signals, nLMTP and nLMTM, are used for stopping the pulse output if the limit sensors of + and - directions are triggered. When the limit signal and also the logical level are active, the command of sudden stop or decelerating stop can be set by bits D3 and D4 (HLMT+, HLMT-), and D2 (LMTMD) of register WR2.
30
MCX314
2.6.5 Interface to Servo Motor Drivers
Enable / Disable and logical levels of the input signals for connecting servo motor drivers such as nINPOS (in-position input signal) and nALARM (alarm input signal) can be set by D15~12 bits of register WR2. nINPOS input signal responds to the in-position signal of servo motor driver. When " enable" is set, and when the driving is finished, nINPOS will wait for the " active" . Then, the n-DRV bit of main status register PRO will return to 0. nALARM input signal receives the alarm signal from servo motor drivers. When " enable" is set, nALARM signal will be monitored, and the D4 (alarm) bit of RR2 register is 1 when nALARM is active. The sudden stop will occur in the driving when this signal is active. These input signals from servo motor drivers can be read by RR5 and RR6 registers The user can use general output signals nOUT7~4 or nOUT3~0 to clear and/or reset the out put signals such as deviation counter and alarm reset of servo motor drivers.
www..com 2.6.6
Emergency Stop
Signal EMGN is able to perform the emergency stop function for all of the 4 axes during the driving. Normally, this signal is kept on the Hi level. When it is falling to the Low level, all axes will stop immediately, and the D5 (EMG) bit of register RR2 (each axis) becomes 1. Please be noted that there is no way to select the logical level of EMGN signal. Please check the following methods to perform the emergency stop function from the host CPU. Execute the sudden stop commend for all of the 4 axes at the same time... Appoint all of the 4 axes, then write the sudden stop command (27h) to register WR0. - Reset software limit... Write 800h to register WR0 to reset software limit.
2.6.7 Status Output
Speed
nDRIVE output signals and bits D3~0 (n-DRV) of register RR0 can be used for drive / stop status output of each axis. The driving status of acceleration / constant speed / deceleration will be output to bits D2 (ASND), D3 (CNST) and D4 (DSDN), and also the signals nOUT6 / ASND and nOUT7 / DSND will show the levels. However, these output signals and general purpose output signals share the same terminal, D7 (OUTSL) bit of register WR3 should be set 1 for drive status output.
Stop
Acceleration Constant speed Deceleration Stop
Time
Status Register Output Signal RR0/n-DRV nRR1/ASN nRR1/CNS nRR1/DSN nDRIVE nOUT6/AS nOUT7/DS D T D ND ND Stop 0 0 0 0 Low Low Low Acceleration 1 1 0 0 Hi Hi Low Constant Speed 1 0 1 0 Hi Low Low Deceleration 1 0 0 1 Hi Low Hi Moreover, in S-curve accelerating/decelerating driving, the state of acceleration /constant speed/ deceleration will be also shown to bits D5 (AASND), D6 (ACNST), and D7 (ADSND) of register RR1. Drive Status
2.6.8 General Purpose Output
In MCX314, there are 8 general purpose output pins, nOUT3~0 & nOUT7~4, for each axis. However, during the outputting, nOUT7~4 cannot be used cause they share the same terminals with the position comparison output and drive status output. NOUT3~0 can be output when the output levels of register WR4 have been set. If the user wants to use nOUT7~4 signals, D7(OUTSL) of register WR3 should be set in the " general purpose output mode" , then the output levels of D11~8(OUT7~4) of register WR3 can be set for outputting. It is possible to use the general purpose output signal for motor driver current-OFF, deviation counting clear and alarm reset... When resetting, each bit of WR4 and nWR3 registers will be cleared, then, their output levels will be kept
31
MCX314 on the Low level.
www..com
32
MCX314
3. Pin Assignments and Signal Description
ZOUT4/CMPP ZOUT5/CMPM ZOUT6/ASDN ZOUT7/DSND ZDRIVE GND ZIN0 ZIN1 ZIN2 ZIN3 ZLMTM ZLMTP ZALARM ZINPOS YIN0 YIN1 YIN2 GND VDD YIN3 YLMTM YLMTP YALARM YINPOS YOUT0 YOUT1 YOUT2 YOUT3 YOUT4/CMPP YOUT5/CMPM YOUT6/ASND YOUT7/DSND YDRIVE GND XIN0 XIN1 VDD ZOUT3 ZOUT2 ZOUT1 ZOUT0 UINPOS www..com UALARM ULMTP ULMTM UIN3 UIN2 UIN1 UIN0 UDRIVE UOUT7/DSND UOUT6/ASND UOUT5/CMPM VDD GND UOUT4/CMPP UOUT3 UOUT2 UOUT1 UOUT0 GND XEXPP XEXPM YEXPP YEXPM ZEXPP ZEXPM UEXPP UEXPM EMGN GND VDD 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133 134 135 136 137 138 139 140 141 142 143 144 108 107 106 105 104 103 102 101 100 99 98 97 96 95 94 93 92 91 90 89 88 87 86 85 84 83 82 81 80 79 78 77 76 75 74 73 72 71 70 69 68 67 66 65 64 63 62 61 60 59 58 57 56 55 54 53 52 51 50 49 48 47 46 45 44 43 42 41 40 39 38 37
NOVA elec. MCX314
Pin 1 Mask
XIN2 XIN3 XLMTM XLMTP XALARM XINPOS GMD VDD XOUT0 XOUT1 XOUT2 XOUT3 XOUT4/CMPP XOUT5/CMPM XOUT6/ASND XOUT7/DSND XDRIVE GND VDD CLK GND UECB/PMIN UECA/PPIN ZECB/PMIN ZECA/PPIN YECB/PMIN YECA/PPIN XECB/PMIN XECA/PPIN UPM/DIR UPP/PLS ZPM/DIR ZPP/PLS YPM/DIR YPP/PLS GND
D15 D14 D13 D12 D11 D10 D9 D8 GND D7 D6 D5 D4 D3 D2 D1 D0 VDD GND GND A3 A2 A1 A0 CSN WRN RDN RESETN EXPLSN H16L8 TESTN BUSYN INTN SCLK XPP/PLS XPM/DIR
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36
144pinQFP, Dimension: 30.9x30.9 mm, Pitch: 0.65mm
33
MCX314
n Signal Description
Signals XOOO, YOOO, ZOOO, and UOOO are input / output signals for X, Y, Z, and U axes, where n stands for X, Y, Z, and U. If the signals are named OOON, they are negative-active or low-active.
Signal Name CLK Pin No. 53 Input /Output Input A Signal Description Clock: clock signal for internal synchronous loop of MCX314 The standard frequency is 16 MHz. This signal is for drive speed, acceleration / deceleration and jerk. If the frequency setting is not 16 MHz, the setting values of speed and acceleration / deceleration are different.
D15-D0
1~8, 10~17
BiDATA BUS: 3-state bi-direction 16-bit data bus directional A When CSN=Low and RDN=Low, these signals are for outputting. Otherwise, they are high impedance inputs. If 8-bit data bus is used, D15-D8 can not be used, and D15-D8 should be pull up to + 5V through high impedance (about 100 k) Input A Input A Input A Address: address signal for host CPU to access the write / read registers A3 is used only when the 8-bit data bus is used. Chip Select: input signal for selecting I/O device for MCX314 Set CSN to the Low level for data reading and writing. Write Strobe: its level is Low while data is being written to MCX314. When WRN is Low, CSN and A3-A0 must be assured. When WRN is up ( othe data will be latched in the write register, and while WRN is up ), ( othe levels of D15~D0 should be assured. ), Read Strobe: its level is Low while data is being read from MCX314. Only when CSN is on the low level, the selected read register data from A3~A0 address signals can be output from the data bus. Reset: reset (return to the initial setting) signal for MCX314. Setting RESETN to Low for more than 4 CLK cycles will reset MCX314. The RESETN setting is necessary when the power is on. (Note) If there is no clock input to MCX314, setting the RESETN to Low still cannot reset this IC. External Pulse: pulse input signal for external pulse interpolation The normal setting is Hi level. When the external pulse interpolation occurs, EXPLSN is down ( othe interpolation calculation starts, and one pulse for ), each axis interpolation is output. The width of EXPLSN on the Low level must be more than 4 CLK. Hi=16-bit, Low=8-bit: data bus width selection for 16-bit / 8-bit When the setting is Hi, 16-bit data bus is selected for processing the 16-bit data reading / writing in IC; when the setting is Low, 8-bit data bus (D7~D0) is active for data reading / writing. Test: terminal for internal-circuit test Please open, or connect it to + 5V. Busy: reflecting the execution of the input command at this moment Once the command is written to MCX314, the process will take 2 CLK to 4 CLK (250nsec for 16MHz) on the Low level. When BUSYN is on the Low level, the other written commands cannot be executed. Interrupt: outputting an interrupt signal to the host CPU. If any interrupt factor occurs the interrupt, the level is Low; when the interrupt is released, it will return to the Hi-Z level. System Clock: SCLK=CLK/2 All the signals in MCX314 are controlled and synchronized by internal SCLK. When the output signal of each axis is latched, it can be used as an external signal source. There is no SCLK output when RESETN is on the Low level. Pulse +/Pulse: + direction dive pulse outputting When the reset is on the Low level, and while the driving is starting, DUTY 50% (at constant speed) of the plus drive pulses are outputting. + or - pulse mode is selectable. When the 1-pulse 1-direction mode is selected, this terminal is for drive output.
www..com A3-A0
21~24 25 26
CSN WRN
RDN
27
Input A
RESETN
28
Input A
EXPLSN
29
Input A
H16L8
30
Input A
TESTN BUSYN
31 32
Input A Output B
INTN
33
Output B
SCLK
34
Output A
XPP/PLS YPP/PLS ZPP/PLS UPP/PLS
35 38 40 42
Output A
34
MCX314
Signal Name XPM/DIR YPM/DIR ZPM/DIR UPM/DIR Pin No. 36 39 41 43 Input /Output Output A Signal Description Pulse -/Pulse: - direction dive pulse outputting When the reset is on the Low level, and while the driving is starting, DUTY 50% (at constant speed) of the plus drive pulses are outputting. + or - pulse mode is selectable. When the 1-pulse 1-direction mode is selected, this terminal is direction signal.
XECA/PPIN YECA/PPIN ZECA/PPIN UECA/PPIN
www..com
44 46 48 50 45 47 49 51 56 76 104 122 57 77 105 123 58 78 106 124 59 79 107 125 60 80 108 128 61~64 81~84 110~113 129~132
Input A
Encoder-A/Pulse +in: signal for encoder phase-A input This input signal, together with phase-B signal, will make the Up / Down pulse transformation to be the input count of real position counter. When the Up / Down pulse input mode is selected, this terminal is for UP pulses input. Once the input pulse is up ( othe real position counter is ), counting up. Encoder-B/Pulse -in: signal for encoder phase-B input This input signal, together with phase-A signal, will make the Up / Down pulse transformation to be the input count of real position counter. When the Up / Down pulse input mode is selected, this terminal is for DOWN pulses input. Once the input pulse is up ( othe real position ), counter is counting down. Drive: output signal of driving It will become Hi level when the driving command of +/- direction pulse output is executed. When the nINPOS signal of servo motor is enabled, nINPOS will be active, and the Drive will become Hi. General Output 7 / Descend: general purpose output signals After the axis is appointed by WR0 register, nOUT7~4 can output the 1/0 data of D11~8 in WR3 register to Hi / Low. They become Low when the IC is reset . When the drive status output mode is engaged, this signal can be used for reflecting the status of deceleration. While the driving command is executed and during the deceleration, it becomes Hi. General Output 6 / Ascend: general purpose output signals (the operation is as same as nOUT7) When the drive status output mode is engaged, this signal can be used for reflecting the status of acceleration. While the driving command is executed and during the acceleration, it becomes Hi. General Output 5 / Compare-: general purpose output signals (the operation is as same as nOUT7) When the drive status output mode is engaged, it becomes Hi if the value of logical / real position counter is smaller than that of COMP-; it becomes Low if the value of logical / real position counter is larger than that of COMP-. General Output 4 / Compare+: general purpose output signals (the operation is as same as nOUT7) When the drive status output mode is engaged, it becomes Hi if the value of logical / real position counter is larger than that of COMP+; it becomes Low if the value of logical / real position counter is smaller than that of COMP+. General Output 3~0: 4 general output signals for each axis nOUT3~0 can output the 1/0 data of D15~0 in WR4 register to Hi / Low. They become Low when the IC is reset. Compared with the setting of nOUT7~4, it is easier cause there is no need to have the appointed axis.
XECB/PMIN YECB/PMIN ZECB/PMIN UECB/PMIN XDRIVE YDRIVE ZDRIVE UDRIVE XOUT7/DSND YOUT7/DSND ZOUT7/DSND UOUT7/DSND XOUT6/ASND YOUT6/ASND ZOUT6/ASND UOUT6/ASND XOUT5/CMPM YOUT5/CMPM ZOUT5/CMPM UOUT5/CMPM XOUT4/CMPP YOUT4/CMPP ZOUT4/CMPP UOUT4/CMPP XOUT3-0 YOUT3-0 ZOUT3-0 UOUT3-0
Input A
Output A
Output A
Output A
Output A
Output A
Output A
35
MCX314
Signal Name XINPOS YINPOS ZINPOS UINPOS Pin No. 67 85 95 114 Input /Output Input A Signal Description In-position: input signal for servo driver in-position Enable / disable and logical levels can be set as commands. When " enable" is set, and after the driving is finished, this signal is active and standby. nDVR bit of main status register returns to 0.
www..com
XALARM YALARM ZALARM UALARM XLMTP YLMTP ZLMTP ULMTP XLMTM YLMTM ZLMTM ULMTM XIN3-0 Y IN3-0 Z IN3-0 U IN3-0 XEXPP YEXPP ZEXPP UEXPP XEXPM YEXPM ZEXPM UEXPM EMGN
68 86 96 115 69 87 97 116 70 88 98 117 71~74 89,92~94 99~102 118~121 134 136 138 140 135 137 139 141 142
Input A
Servo Alarm: input signal for servo driver alarm Enable / disable and logical levels can be set as commands. When it is enable and when this signal is in its active level, the ALARM bit of RR2 register becomes 1. OVER Limit +: signal of + direction over limit During the + direction drive pulse outputting, decelerating stop or sudden stop will be performed once this signal is active. The active pulse width should be more than 2CLK. Decelerating stop / sudden stop and logical levels can be set during the mode selection. When it is enable, and when this signal is in its active level, the HKMT+ of RR2 register becomes 1. OVER Limit -: signal of - direction over limit During the - direction drive pulse outputting, decelerating stop or sudden stop will be performed once this signal is active. The active pulse width should be more than 2CLK. Decelerating stop / sudden stop and logical levels can be set during the mode selection. When it is enable, and when this signal is in its active level, the HKMT- of RR2 register becomes 1. Input 3~0: input signal to perform decelerating / sudden stop for each axis These signals can be used for HOME searching. The active pulse width should be more than 2CLK. Enable / disable and logical levels can be set for IN3~IN0. The signal status can be read from register RR4 / RR5. External Operation +: + direction drive starting signal from external source When the fixed pulse driving is commanded from an external source, + direction driving will start if this signal is down ( o ). Otherwise, when the continuous pulse driving is commanded from an external source, + driving will start if this signal is on the Low level. External Operation -: - direction drive starting signal from external source When the fixed pulse driving is commanded from an external source, direction driving will start if this signal is down ( o ). Otherwise, when the continuous pulse driving is commanded from an external source, - direction driving will start if this signal is on the Low level. Emergency Stop: input signal to perform the emergency stop for all axes When this signal is on the Low level, including the interpolation driving, every axes will stop the operation immediately. EMG bit of register RR2, of each axis, will become 1. The Low level pulse width should be more than 2CLK. (Note) For this signal, its logical levels cannot be selected. Ground (0V) Terminal All of the 13 pins must be connected to 0V.
Input A
Input A
Input A
Input A
Input A
Input A
GND
9,19,20, 37,52,55, 66,75,91, 103,127, 133,143 18,54,65, 90,109, 126,144
VDD
+ 5V Power Terminal. All of the 7 pins must be connected to +5V.
n Input/ Output Loop
36
MCX314 Input A More than 10 k ~ hundreds of kilo impedance is for internal impedance, which can pull up the VDD to the TTL level input of Smith trigger. CMOS and TTL can be connected. The user should open, or pull up with + 5V if the input is not used. It is CMOS level output, 4mA driving buffer (Hi level output current IOH=-4mA, VOH=2.4Vmin, Low level output current IOL=4mA, VOL=0.4Vmax). Up to 10 LSTTL can be driven. It is open collector type output, 4mA driving buffer, (Low level output current IOL=4mA, VOL=0.4Vmax). Pull up to +5V with high impedance if this output is used. Input side is TTL Smith trigger. Because there is no pull high resister for those signals in this IC, the user should pull up the data bus with high impedance. The user should pull up to +5V with high impedance (about 100 k) when bits D15~D8 are not used. Output side is CMOS level output, 8mA driving buffer (Hi level output current IOH=-8mA, VOH=2.4Vmin, Low level output current IOL=8mA, VOL=0.4Vmax).
Output A
Output B
Bi-directional A
www..com
n Notes for the Design of Circuitry
(1) De-coupling Capacitor Please connect VDD and GND with one or two De-coupling capacitors (about 0.1F). (2) Noise Generated by Terminal Induction The noise will exist because the inductance is in these pins. Th user can add a capacitor (10-100pF) to pins to reduce the noise. (3) Reflection on Transfer Path The load capacity for outputting types A, B, and bi-direction type A is 20-50pf. So, the reflection will happen if the PCB wiring is more than 60cm.
37
MCX314
4. Register
This chapter indicates the user how to access all the registers in MCX314, and what are the mapping addresses of these registers. Please refer to Chapter 2.4.3 for the registers (BP1P/M, BP2P/M, BP3P/M) of bit pattern interpolation.
4.1 Register Address by 16-bit Data Bus
As shown is the table below, when 16-bit data bus is used, the access address of read / write register is 8-bit n Write Register in 16-bit Data Bus All registers are 16-bit length. Address Symbol Register Name Contents A2 A1 A0 0 0 0 WR0 Command Register for setting axis assignment and command www..com 0 0 1 XWR1 X axis mode register 1 for setting the logical levels of external decelerating stop, enable / disable, and YWR1 Y axis mode register 1 the valid / invalid of interrupt for each axis for ZWR1 Z axis mode register 1 each axis UWR1 U axis mode register 1 0 1 0 XWR2 YWR2 ZWR2 UWR2 BP1P X axis mode register 2 Y axis mode register 2 Z axis mode register 2 U axis mode register 2 BP1P register for setting the limit signal mode, driving pulse mode, encoder input signal mode, and the logical levels and enable / disable of servo motor signal for each axis
l
l
l l
for setting the + direction bit data of the first axis in bit pattern interpolation 0 1 1 XWR3 X axis mode register 3 for setting the manual deceleration, individually decelerating, and S-curve YWR3 Y axis mode register 3 acceleration/ deceleration mode for each axis, ZWR3 Z axis mode register 3 external operation mode, and UWR3 U axis mode register 3 general purpose output OUT7~4 BP1M BP1M register for setting the - direction bit data of the first axis in bit pattern interpolation 1 0 0 WR4 Output register for setting the general output OUT3 ~ 0. BP2P BP2P register for setting the + direction bit data of the second axis in bit pattern interpolation 1 0 1 WR5 Interpolation mode axis assignment register for settings the constant speed driving mode, step output mode and interrupt BP2M BP2M register for setting the - direction bit data of the second axis in bit pattern interpolation 1 1 0 WR6 Data writing register 1 for setting the low word 16-bit (D15-D0) for data writing. BP3P BP3P register for setting the + direction bit data of the third axis in bit pattern interpolation 1 1 1 WR7 Data writing register 2 for setting the high word 16-bit (D31-D16) for data writing. BP3M BP3M register for setting the - direction bit data of the third axis in bit pattern interpolation Each axis is with WR1, WR2 and WR3 mode registers. Each register is for 4-axis data writing (at the same address). Before those registers have been accessed, the host CPU should specify which axis is going to be accessed by writing a NOP command into WR0. The register for bit pattern interpolation are BP1P~3P and BP1M~3M. After the resetting, the data writing cannot be performed, until the enable command (36h) is engaged by BP register. After the command 36h is enabled, the data writing cannot be performed in nWR2~3. So, the disable command (37h) should be engaged after the bit pattern interpolation data is written. Please be noted that registers WR6 and BP3P / WR7 and BP3M share the same register hardware. The bits of nWR1, nWR2, nWR3, nWR4 and nWR5 will be cleared to 0 after the resetting. It will be unknown for other registers. 38
MCX314 n Read Register in 16-bit Data Bus All registers are 16-bit length. Address A2 A1 A0 000 Symbol RR0 Register Name Main status register Contents error status, driving status, ready for interpolation, quadrant for circle interpolation and the stack of BP comparison result, acceleration status and finishing status
XRR1 X axis status register 1 YRR1 Y axis status register 1 ZRR1 Z axis status register 1 URR1 U axis status register 1 0 1 0 XRR2 X axis status register 2 error message YRR2 Y axis status register 2 ZRR2 Z axis status register 2 www..com URR2 U axis status register 2 0 1 1 XRR3 X axis status register 3 YRR3 Y axis status register 3 interrupt message ZRR3 Z axis status register 3 URR3 U axis status register 3 1 0 0 RR4 Input register 1 I/O input for X and Y axes 1 0 1 RR5 Input register 2 I/O input for Z and U axes 1 1 0 RR6 Data reading register 1 low word of data register (D15 ~ D0) 1 1 1 RR7 Data reading register 2 high word of data register (D31 ~ D16) l Each axis is with WR1, WR2 and WR3 mode registers. Each register is for 4-axis data writing (at the same address). Before those registers have been accessed, the host CPU should specify which axis is going to be accessed by writing a NOP command into WR0.
0
0
1
39
MCX314
4.2 Register Address by 8-bit Data Bus
In case of the 8-bit data bus access, the 16-bit data bus can be divided into high and low word byte. As shown in the table below, xxxxL is the low word byte (D7~D0) of 16-bit register xxxx; xxxxH is the high word byte (D15~8) of 16-bit register xxxx. Only for the command register (WR0L, WR0H), the user must write to the high word byte (WR0L), then to the low word byte (WR0H). n Write Register in 8-bit Data Bus Address Write Register A3 A2 A1 A0 0 0 0 0 WROL 0 0 0 1 WROH 0 0 1 0 XWR1L, YWR1L, ZWR1L, UWR1L www..com 0 0 1 1 XWR1H, YWR1H, ZWR1H, UWR1H 0 1 0 0 XWR2L, YWR2L, ZWR2L, UWR2L 0 1 0 1 XWR2H, YWR2H, ZWR2H, UWR2H 0 1 1 0 XWR3L, YWR3L, ZWR3L, UWR3L 0 1 1 1 XWR3H, YWR3H, ZWR3H, UWR3H 1 0 0 0 WR4L, BP2PL 1 0 0 1 WR4H, BP2PH 1 0 1 0 WR5L, BP2ML 1 0 1 1 WR5H, BP2MH 1 1 0 0 WR6L, BP3PL 1 1 0 1 WR6H, BP3PH 1 1 1 0 WR7L, BP3ML 1 1 1 1 WR7H, BP3MH n Read Register in 8-bit Data Bus Address Read Register A3 A2 A1 A0 0 0 0 0 RROL 0 0 0 1 RROH 0 0 1 0 XRR1L, YRR1L, ZRR1L, URR1L 0 0 1 1 XRR1H, YRR1H, ZRR1H, URR1H 0 1 0 0 XRR2L, YRR2L, ZRR2L, URR2L 0 1 0 1 XRR2H, YRR2H, ZRR2H, URR2H 0 1 1 0 XRR3L, YRR3L, ZRR3L, URR3L 0 1 1 1 XRR3H, YRR3H, ZRR3H, URR3H 1 0 0 0 RR4L, BP2PL 1 0 0 1 RR4H, BP2PH 1 0 1 0 RR5L, BP2ML 1 0 1 1 RR5H, BP2MH 1 1 0 0 RR6L, BP3PL 1 1 0 1 RR6H, BP3PH 1 1 1 0 RR7L, BP3ML 1 1 1 1 RR7H, BP3MH
40
MCX314
4.3 Command Register: WR0
Command register is used for the axis assignment and command registration for each axis in MCX314. The register consists of the bit for axis assignment, bit for setting command code, and bit for command resetting. After the axis assignment and command code have been written to the register, this command will be executed immediately. The data such as drive speed setting and data writing command must be written to registers WR6 and WR7 first. Otherwise, when the reading command is engaged, the data will be written and set, through IC internal circuit, to registers RR6 and RR7. When using the 8-bit data bus, the user should write data into the high word byte (H), then low word byte (L). It requires 250 nSEC (maximum) to access the command code when CLK=16MHz. The input signal BUSYN is on the Low level at this moment. Please don' t write the next command into WR0 before BUSYN return to the Hi level. H D12 D11
0 U
L D10
Z
D15
www..com WR0 RESE
D14
0
D13
0
D9
Y
D8
X
D7
0
D6
0
D5
D4
D3
D2
D1
D0
T
Axis Assignment D5 ~ 0
Command Code
Command code setting Please refer to chapter 5 and the chapters following for further description of command codes. Axis assignment When the bits of the axis are set to 1, the axis is assigned. The assignment is not limited only for one axis, but for multi-axes simultaneously. It is possible to write the same parameters also. However, the data reading is only for one assigned axis. Whenever the interpolation is commanded, the bits of the assigned axis (axes) should be set 0. RESET IC command resetting When this bit is set to 1, but others are 0, the IC will be reset after command writing. After command writing, the BUSYN signal will be on the Low level within 875 nSEC (When CLK=16 MHz) maximum. When 8-bit data bus is used, the reset is activated when the command (80h) is written to register WR0H. RESET bit should be set to 0 when the other commands are written.
D11 ~ 8
D15
4.4 Mode Register1: WR1
Each axis is with mode register WR1. The axis specified by NOP command or the condition before decide which axis' s register will be written. The register consists of the bit for setting enable / disable and enable logical levels of input signal IN3~IN0 (decelerating stop / sudden stop during the driving) and bit for occurring the interrupt enable / disable. Once IN3~IN1 are active, when the fixed pulse / continuous pulse driving starts, and also when IN signal becomes the setting logical level, the decelerating stop will be performed during the acceleration / deceleration driving and the sudden stop will be performed during the constant speed driving . H D12 D11 L D10 D9 D8 D7 D6 D5 D4 D3 D2 D1 D0
PC- PULS E IN3-E IN3-L IN2-E IN2-L IN1-E IN1-L IN0-E IN0-L
D15 WR1
D14
D13
D- C-STA CEND END
PC+ PInterrupt Enable / Disable D7,5,3,1 INm-E D6,4,2,0 INm-L
Driving Stop Input Signal Enable / Disable
The bit for setting enable / disable of driving stop input signal INm 0: disable, 1: enable The bit for setting enable logical levels for input signal INm 0: stop on the Low level, 1: stop on the Hi level For the following bits, the interrupt is set: 1: enable, 0: disable D8 PULSE Interrupt occurs when the pulse is up ( o ) (drive pulse is set on the positive logical level) D9 PCInterrupt occurs when the value of logical / real position counter is larger than or equal
41
MCX314 to that of COMP- register D10 P < CInterrupt occurs when the value of logical / real position counter is smaller than that of COMP- register D11 Pwww..com 4.5 Mode
Register2: WR2
WR2 can be used for setting: (1). external limit inputs, (2). driving pulse types, (3). encoder signal types, and (4). the feedback signals from servo drivers. H L D15 D14 D13 D12 D11 D10 D9 D8 D7 D6 D5 D4 D3 D2 D1 D0 WR2
INP-E INP-L ALM-E ALM-L PIND1 PIND0 PINM D DIR-L PLS-L PLSM CMPS HLMT- HLMT LMTM SLMT- SLMT D L + D +
D0
SLMT +
D1
D2 D3 D4 D5 D6
D7 D8
Enable / disable setting for COMP+ register which is used as the + direction software limit 1: enable, 0: disable Once it is enabled during the + direction driving, if the value of logical / real position counter is larger than that of COMP+, the decelerating stop will be performed. The D0 (SLMT+) bit of register RR2 will become 1. Under this situation, further written + direction driving commends will not be executed. SLMT Enable / disable setting for COMP- register which is used as the - direction software limit 1: enable, 0: disable Once it is enabled during the - direction driving, if the value of logical / real position counter is smaller than that of COMP+, the decelerating stop will be performed. The D1 (SLMT-) bit of register RR2 will become 1. Under this situation, further written direction driving commends will not be executed. LMTMD The bit for controlling stop type when the hardware limits (nLMTP and nLMTM input signals) are active 0: sudden stop, 1: decelerating stop HLMT + Setting the logical level of + direction limit input signal (nLMTM) 0: active on the Low level, 1: active on the Hi level HLMT Setting the logical level of - direction limit input signal (nLMTM) 0:active on the Low level, 1: active on the Hi level COMPSL Setting if real position counter or logical position counter is going to be compared with COMP +/- register 0: logical position counter, 1 : real position counter PLSMD Setting output pulse type 0: independent 2-pulse type, 1: 1-pulse 1-direction type When independent 2-pulse type is engaged, + direction pulses are output through the output signal nPP/PLS, and - direction pulses through nPM/DIR. When 1-pulse 1-direction type is engaged, + and - directions pulses are output through the output signal nPP/PLS, and nPM/DIR is for direction signals. [Note] Please refer to Chapter 13.2 and 13.3 for the output timing of pulse signal (nPLS) and direction signal (nDIR) when 1-pulse 1-direction type is engaged. PLS-L Setting logical level of driving pulses 0: positive logical level, 1: negative logical level DIR-L Setting logical level of the direction (nPM/DIR) output signal for 1-pulse mode DIR-L + direction - direction 0 Low Hi 1 Hi Low Setting the type of encoder input signals (nECA/PPIN and nECB/PMIN) 0: quadrature pulse input type 1: Up / Down pulse input type Real position counter will count up or down when encoder input signal is triggered. When quadrature pulse input type is engaged, the " count up" will happen if the positive 42
D9
PINMD
MCX314 logical level pulses are input to phase A; the " count down" will happen if the positive logical level pulses are input to phase B. So, it will count up and down when these 2 signals go up( o ) and down( o ). When Up / Down pulse input type is engaged, nECA/PPIN is for " count up" input, and nECB/PMIN is for " count down" input. So, it will count up when the positive pulses go up ( o ). D11,10 PIND 1,0 The division setting for quadrature encoder input. D11 D10 Division Up / down pulse input is not 0 0 1/1 available. 0 1 1/2 1 0 1/4 1 1 Invalid D12 ALM-L Setting active level of input signal nALARM 0: active on the Low level, 1: active on the Hi level www..com D13 ALM-E Setting enable / disable of servo alarm input signal nALARM 0: disable, 1: enable When it is enabled, MCX314 will check the input signal. If it is active, D14(ALARM) bit of RR2 register will become 1. The driving stops. D14 INP-L Setting logical level of nINPOS input signal 0: active on the Low level, 1: active on the Hi level D15 INP-E Setting enable/disable of in-position input signal nINPOS from servo driver 0: disable, 1: enable When it is enabled, bit n-DRV of RR0 (main status) register doesn' t return to 0 until nINPOS signal is active after the driving is finished. D15~D0 will be set to 0 while resetting.
4.6 Mode Register3: WR3
Each axis is with mode register WR3. The axis specified by NOP command or the condition before decides which axis' s register will be written. WR3 can be used for manual deceleration, individual deceleration, S-curve acceleration / deceleration, the setting of external operation mode, and the setting of general purpose output OUT7~4. H L D15 D14 D13 D12 D11 D10 D9 D8 D7 D6 D5 D4 D3 D2 D1 D0 WR3
0 0 0 0 OUT7 OUT6 OUT5 OUT4 OUTS L 0 0 EXOP EXOP SACC DSND MANL 1 0 E D
D0
D1
D2
D4,3
Setting manual / automatic deceleration for the fixed pulse acceleration / deceleration driving 0: automatic deceleration, 1: manual deceleration The decelerating point should be set if the manual deceleration mode is engaged. DSNDE Setting decelerating rate which is in accordance with the rate of the acceleration or an individual decelerating rate 0: in accordance with the rate of the acceleration 1: individual decelerating rate setting When 0 is set, the deceleration will follow the acceleration setting. So, 0 must be set for automatic deceleration. When 1 is set, the rates of acceleration and deceleration should be different, So, 1 must be set for manual deceleration. SACC Setting trapezoidal driving / S-curve acceleration / deceleration driving 0: trapezoidal driving, 1: S-curve acceleration / deceleration driving Before S-curve acceleration / deceleration driving is engaged, jerk (K) should be set. EXOP1,0 Setting the external input signals (nEXPP, nEXPM) for driving D4 D3 0 0 external signals disabled 0 1 continuous driving mode 1 0 fixed pulse driving mode 1 1 external signals disabled When the continuous driving mode is engaged, the + direction drive pulses will be output continuously once the nEXPP signal is on the Low level; the - direction pulses will be output continuously once the nEXPM signal is on the Low level. When the fixed pulse driving mode is engaged, the + direction fixed pulse driving starts once the nEXPP signal is falling to the Low level from the Hi level; the - direction fixed pulse
43
MANLD
MCX314 driving starts once the nEXPM signal is falling to the Low level from the Hi level. D7 OUTSL Driving status outputting or used as general purpose output signals (nOUT7~4) 0: nOUT7~4: general purpose output The levles of D11~8 will be output through nOUT7~4. 1: nOUT4~7: driving status output (see the table below) Signal Name Output Description OUT4/CMPP Hi: if logical / real position counter COMP+ register Low : if logical / real position counter < COMP+ register OUT5/CMPM Hi: if logical / real position counter < COMP- register Low: if logical / real position counter COMP- register OUT6/ASND When the driving command is engaged, the level becomes Hi once the driving status is in acceleration. OUIT7/DSND When the driving command is engaged, the level becomes Hi once the driving status is in deceleration. www..com D11~8 OUTm Level setting for output signals OUT7~4 as general purpose output signals 0: Low level output, 1: Hi level output D15~D0 will be set to 0 while resetting. D15~12, D5 and D6 should be always set 0.
44
MCX314
4.7 Output Register: WR4
This register is used for setting the general purpose output signals nOUT3~0. This 16-bit register locates 4 output signals of each axis. It can be also used as a 16-bit general purpose output. It is Low level output when the bit is set 0, and Hi level output when the bit is set 1. H D12 D11
0 3
L D10
2
D3 D2 D1 D0 WR4 UOUT UOUT UOUT UOUT ZOUT ZOUT ZOUT ZOUT YOUT YOUT YOUT YOUT XOUT XOUT XOUT XOUT
3 2 1 1 0 3 2 1 0 3 2 1 0
D15
D14
D13
D9
D8
D7
D6
D5
D4
D15~D0 will be set to 0 while resetting, and nOUT3~0 signals become Low level.
4.8 Interpolation Mode Register: WR5
This www..com register is used for setting axis assignment, constant vector speed mode, 1-step interpolation mode and interrupt during the interpolation. H L D15 D14 D13 D12 D11 D10 D9 D8 D7 D6 D5 D4 D3 D2 D1 D0
0 CMPL EXPL S S 0 LSPD LSPD 1 0 0 0 AX31 AX30 AX21 AX20 AX11 AX10
WR5 BPINT CIINT
Interrupt D1, 0
Step output
Constant Vector Speed
ax3
ax2
Ax1
AX11, 10 ax1 (master axis) assignment for interpolation Axis codes are shown as follows.
Axis Code (Binary) 1st axis: X, 2nd axis: Y, 3rd axis: Z X 0 0 Y 0 1 D5 D4 D3 D2 D1 D0 Z 1 0 1 0 0 1 0 0 U 1 1 For ax1 (master axis) will have the basic pulses of starting interpolation calculation, the speed parameter which is for constant / acceleration / deceleration driving should be set before the driving. D3, 2 AX21, 20 ax2 assignment according to the codes shown in the table above D5,4 AX31, 30 ax3 assignment for 3-axis interpolation, according to the codes shown in the table above Setting any value if it is only 2-axis interpolation. D9,8 LSPD1,0 Constant vector speed mode setting of interpolation driving D9 D8 Code (Binary) 0 0 constant vector speed invalid 0 1 2-axis constant vector speed 1 0 (setting not available) 1 1 3-axis constant vector speed When 2-axis constant vector speed mode is engaged, the user should set the range (R) of ax2 to be 1.414 times of the range (R) of master axis (ax1). When 3-axis constant vector speed mode is engaged, the user should set the range (R) of ax2 to be 1.414 times and the range (R) of ax3 to be 1.732 times of the range (R) of master axis (ax1). D11 EXPLS When it is 1, the external (EXPLSN) controlled single step interpolation mode is engaged. D12 CMPLS When it is 1, the command controlled single step interpolation mode is engaged. D14 CIINT Interrupt enable / disable setting during interpolation 0: disable 1: enable D15 BPINT interrupt enable / disable setting during bit-pattern interpolation 0: disable 1: enable D15~D0 will be set to 0 while resetting.
45
MCX314
4.9 Data Register: WR6/WR7
Data registers are used for setting the written command data. The low-word data-writing 16-bit (WD15~WD0) is for register RR6 setting, and the high-word data-writing 16-bit (WD31~WD16) is for register RR7 setting. H D12 D11 L D10 D9 D8
WD8
D15 WR6
D14
D13
D7
WD7
D6
WD6
D5
WD5
D4
WD4
D3
WD3
D2
WD2
D1
WD1
D0
WD0
WD15 WD14 WD13 WD12 WD11 WD10 WD9
D15 WR7
D14
D13
H D12 D11
L D10 D9 D8 D7 D6 D5 D4 D3 D2 D1 D0
wd16
WD31 WD30 WD29 WD28 WD27 WD26 WD25 WD24 WD23 WD22 WD21 WD20 WD19 WD18 wd17
www..com
The user can write command data with a designated data length into the write register. It does not matter to write WR6 or WR7 first (when 8-bit data bus is used, the registers are WR6L, WR6H, WR7L and WR7H). The written data is binary formatted; 2' complement is for negatives. For command data, the user should use designated data length. For instance, to set the finish point of circular interpolation is using 4 bytes. Even the calculation range (-8388608 ~ +833607) is 24-bit long, the user should fill the total 32 bytes. The contents of WR6 and WR7 are unknown while resetting.
46
MCX314
4.10 Main Status Register: RR0
This register is used for displaying the driving and error status of each axis. It also displays interpolation driving, ready signal for continuous interpolation, quadrant of circular interpolation and stack counter of bitpattern interpolation. H D12 D11 L D10 D9 D8 D7 D6 D5 D4 D3 D2 D1 D0
U- Z-ERR Y-ERR X-ERR U- Z-DRV Y-DRV X-DRV ERR DRV Error Status of Each Axis Driving Status of Each Axis
D15 RR0
-
D14
D13
BPSCI BPSC ZONE ZONE ZONE CNEX I-DRV 0 2 1 0 T
D3~0
www..com
n-DRV
D7~4
n-ERR
D8 D9
I-DRV CNEXT
D12~10 ZONE0 ZONE1 ZONE2
Displaying driving status of each axis When the bit is 1, the axis is outputting drive pules; when the bit is 0, the driving of the axis is finished. Once the in-position input signal nINPOS for servo motor is active, nINPOS will return to 0 after the drive pulse output is finished. Displaying error status of each axis If any of the error bits (D5~D0) of each axis' s RR2 register and any of the error-finish bits (D15~D12) of each axis' s RR1 register becomes 1, this bit will become 1. Displaying interpolation driving status While the interpolation drive pulses are outputting, the bit is 1. Displaying the possibility of continuous interpolation data writing When the bit is 1, it is ready for inputting parameters for next node and also ready for writing interpolation command data. Displaying the quadrant of the current position in circular interpolation
D12 0 0 0 0 1 1 1 1 D14, 13
D11 0 0 1 1 0 0 1 1
D10 0 1 0 1 0 1 0 1
Quadrant 0 1 2 3 4 5 6 7
Y
2 3 4 5
1 0 X 7 6
BPSC1, 0 In bit pattern interpolation driving, it displays the value of the stack counter (SC). D14 0 0 1 1 D13 0 1 0 1 Stack Counter (SC) Value 0 1 2 3
In bit pattern interpolation driving, when SC = 3, it shows the stack is full. When SC = 2, there is one word (16-bit) space for each axis. When SC = 1, there is a 2-word (16-bit N for each axis. When SC = 0, it shows all the stacks are empty, and the bit-pattern 2) interpolation is finished.
47
MCX314
4.11 Status Register 1: RR1
Each axis is with status register 1. The axis specified by NOP command or the condition before decide which axis' s register will be read. The register can display the comparison result between logical / real position counter and COMP +/- , the acceleration status of acceleration / deceleration driving, jerk of S-curve acceleration / deceleration and the status of driving finishing. H D12 D11
IN3
L D10
IN2
D15 RR1
D14
D13
D9
IN1
D8
IN0
D7
D6
D5
D4
D3
D2
D1
D0
EMG ALAR M
LMT- LMT+
ADSN ACNS AASN DSND CNST ASND CMP- CMP+ D T D
Stop Status
www..com
D0
CMP +
D1
CMP -
D2 D3 D4 D5 D6
ASND CNST DSND AASND ACNST
D7
ADSND
D11~8
IN3~0
D12 D13 D14 D15
LMT + LMT ALARM EMG
Displaying the comparison result between logical / real position counter and COMP+ register 1: logical / real position counter COMP+ register 0: logical / real position counter < COMP+ register Displaying the comparison result between logical / real position counter and COMPregister 1: logical / real position counter COMP- register 0: logical / real position counter > COMP- register It becomes 1 when in acceleration. Speed It becomes 1 when in constant speed driving. It becomes 1 when in deceleration. In S-curve, it becomes 1 when Time acceleration / deceleration increases. In S-curve, it becomes 1 when ASND=1 CNST=1 DSND=1 acceleration / deceleration keeps constant. Acceleration In S-curve, it becomes 1 when Acceleration Deceleration acceleration / deceleration decreases. If the driving is stopped by one of Time external decelerating stop signals (nIN3 ~ 0), it will become 1. AASND=1 ACNST=1 ADSND=1 AASND=1 ACNST=1 ADSND=1 If the driving is stopped by +direction limit signal (nLMTP), it will become 1. If the driving is stopped by -direction limit signal (nLMTP), it will become 1. If the driving is stopped by nALARM from servo drivers, it will become 1. If the driving is stopped by external emergency signal (EMGN), it will become 1.
n The Status Bits of Driving Finishing These bits are keeping the factor information of driving finishing. The factors for driving finishing in fixed pulse driving and continuous driving are shown as follows: when all the drive pulses are output in fixed-pulse driving, - when deceleration stop or sudden stop command is written, (R) when software limit is enabled, and is active, when external deceleration signal is enabled, and active, when external limit switch signals (nLMTP, nLMTM) become active, when nALARM signal is enabled, and active, and when EMGN signal is on the Low level. Above factors and - can be controlled by the host CPU, and factor (R) can be confirmed by register RR2 even the driving is finished. As for factors ~ , the error status is latched in RR2 until next driving command or a clear command (25h) is written. After the driving is finished, if the error factor bits D15~D12 become 1, n-ERR bit of main status register RRO will become 1. 48
MCX314 Status bit of driving finishing can be cleared when next driving command is written, or when the finishing status clear command (25h) is used.
4.12 Status Register 2: RR2
Each axis is with status register 2. The axis specified by NOP command or the condition before decids which axis' s register will be read. This register is for reflecting the error information. Once the bit becomes 1, it reflects an error occurs. When one or more of D5~D0 bits of RR2 register are 1, n-ERR bits of main status register RR0 become 1. D15 RR2
-
D14
-
D13
-
H D12 D11
- -
L D10
-
D9
-
D8
-
D7
-
D6
-
D5
D4
D3
D2
D1
D0
EMG ALAR HLMT- HLMT SLMT- SLMT M + +
D0 www..com
During the + direction driving, when logical / real position counter COMP+ (COMP+ enabled, and used as software limit) D1 SLMT During the - direction driving, when logical / real position counter < COMP- (COMPenabled, and used as software limit) D2 HLMT + When external +direction limit signal (nLMTP) is on its active level D3 HLMT When external -direction limit signal (nLMTM) is on its active level D4 ALARM When the alarm signal (nALARM) for servo motor is on its active level D5 EMG When emergency stop signal (EMGN) becomes Low level. In driving, when hardware / software limit is active, the decelerating stop or sudden stop will be executed. Bit SLMT+ / - will not become 1 during the reverse direction driving. SLMT +
4.13 Status Register 3: RR3
Each axis is with status register 3. The axis specified by NOP command or the condition before decids which axis' s register will be read. This register is for reflecting the interrupt factor. When interrupt happens, the bit which is with the interrupt factor becomes 1. The user should set the interrupt factor through register WR1 to perform the interrupt. D15 RR3
-
D14
-
D13
-
H D12 D11
- -
L D10
-
D9
-
D8
-
D7
D6
D5
D4
D3
D2
D1
D0
D- C-STA CEND END
PC+ PPC- PULS E
D0 D1 D2 D3 D4 D5 D6 D7
PULSE P CP < CPWhen the drive pulse is up ( o ) (drive pulse is set on the positive logical level) Once the value of logical / real position counter is larger than that of COMP- register Once the value of logical / real position counter is smaller than that of COMP- register Once the value of logical / real position counter is smaller than that of COMP+ register Once the value of logical / real position counter is larger than that of COMP+ register When the pulse output is finished in the constant speed drive during an acceleration / deceleration driving When the pulse output is started in the constant speed drive during an acceleration / deceleration driving When the driving is finished
When one of the interrupt factors occurs an interrupt, the bit of the register becomes 1, and the interrupt output signal (INTN) will become the Low level. The host CPU will read register RR3 of the interrupted axis, the bit of RR3 will be cleared to 0, and the interrupt signal will return to the non-active level. When 8-bit data bus is used, the reading data of RR3L register is cleared.
49
MCX314
4.14 Input Register: RR4 / RR5
RR4 and RR5 are used for displaying the input signal status. The bit is 0 if the input is on the Low level; the bit is 1 if the input is on the Hi level. H D12 D11 L D10 D9 D8 D7 D6 D5 D4 D3 D2 D1 D0
D15 RR4
D14
D13
Y-ALM Y-INP Y-EX- Y-EX+ Y-IN3 Y-IN2 Y-IN1 Y-IN0 X-ALM X-INP X-EX- X-EX+ X-IN3 X-IN2 X-IN1 X-IN0
D15 RR5
D14
D13
H D12 D11
L D10 D9 D8 D7 D6 D5 D4 D3 D2 D1 D0
U-ALM U-INP U-EX- U-EX+ U-IN3 U-IN2 U-IN1 U-IN0 Z-ALM Z-INP Z-EX- Z-EX+ Z-IN3 Z-IN2 Z-IN1 Z-IN0
www..com
Bit Name n-IN0 n-IN1 n-IN2 n-IN3
Input Signal nIN0 nIN1 nIN2 nIN3
Bit Name n-EX+ n-EXn-INP n-ALM
Input Signal nEXPP nEXPM nINPOS nALARM
4.15 Data-Read Register: RR6 / RR7
According to the data-read command, the data of internal registers will be set into registers RR6 and RR7. The low word 16 bits (D15 ~ D0) is set in RR6 register, and the high word 16 bits (D31 ~ D16) is set in RR7 register for data reading. The data is binary formatted; 2' s complement is for negatives. H D12 D11 L D10 D9
RD9
D15 RR6
D14
D13
D8
RD8
D7
RD7
D6
RD6
D5
RD5
D4
RD4
D3
RD3
D2
RD2
D1
RD1
D0
RD0
RD15 RD14 RD13 RD12 RD11 RD10
D15 RR7
D14
D13
H D12 D11
L D10 D9 D8 D7 D6 D5 D4 D3 D2 D1 D0
RD31 RD30 RD29 RD28 RD27 RD26 RD25 RD24 RD23 RD22 RD21 RD20 RD19 RD18 RD17 RD16
50
MCX314
5. Command Lists
n Write Commands Code 00 01 02 03 04 05 06
www..com
Command Range setting Jerk setting Acceleration setting Deceleration setting Initial speed setting Drive speed setting Output pulse numbers / finish point of interpolation setting Manual deceleration point setting Circular center point setting Logical position counter setting Real position counter setting COMP + register setting COMP - register setting Acceleration counter offsetting NOP (used for axis switching)
Symbo l R K A D SV V P DP C LP EP CP CM AO 1 ~ 65,535 1 ~ 8,000 1 ~ 8,000 1 ~ 8,000 1 ~ 8,000
Data Range 8,000,000(multiple=1)~16,000(multiple=500)
Data Length 4 bytes 2 2 2 2 2 4 4 4 4 4 4 4 2
Output pulse numbers: 0~268,435,455 / finish point: -8,388,608~+8,388,607 0 ~ 268,435,455 -8,388,608 ~ +8,388,607 -2.147,483,648 ~ +2,147,483,647 -2.147,483,648 ~ +2,147,483,647 -2.147,483,648 ~ +2,147,483,647 -2.147,483,648 ~ +2,147,483,647 0 ~ 65,535
07 08 09 0A 0B 0C 0D 0F
[Note] Data range is shown above. Some parameter data ranges are shouter than data length. When those parameters are written, the total data length should be completely filled. n Formula Calculation for Parameters Multiple = 8,000,000 R 62.5x106 K x 8,000,000 R Multiple Acceleration = A x 125 x
(PPS/SEC)
Jerk (PPS/SEC2) =
8,000,000 R Multiple
Deceleration = Dx 125 x
(PPS/SEC)
8,000,000 R Multiple
Drive Speed (PPS)= V x
8,000,000 R Multiple
Initial Speed (PPS)= SV x
8,000,000 R Multiple
51
MCX314 n Data Reading Commands Code 10 11 12 13 Command Logical position counter reading Real position counter reading Current drive speed reading Acceleration / deceleration reading Symbol LP EP CV CA Data Range -2,147,483,648 ~ +2,147,483,647 -2,147,483,648 ~ +2,147,483,647 1~8,000 1~8,000 Data Length 4 bytes 4 2 2
n Driving Commands Code Command 20h
www..com
n Interpolation Commands Code Command 30h 31h 32h 33h 34h 35h 36h 37h 38h 39h 3Ah 3Bh 3Ch 3Dh 2-axis leaner interpolation 3-axis leaner interpolation CW circular interpolation CCW circular interpolation 2-axis bit pattern interpolation 3-axis bit pattern interpolation BP register writing enabled* BP register writing disabled BP data stack BP data clear 1-step interpolation Deceleration valid Deceleration invalid Interpolation interrupt clear
+ direction fixed pulse driving - direction fixed pulse driving + direction continuous driving - direction continuous driving Drive start holding Drive start holding release / stop status clear Decelerating stop Sudden stop
21h 22h 23h 24h 25h 26h 27h
*BP = bit pattern [Note] Please do not write the codes not mentioned above. The unknown situation could happen due to IC internal circuit test.
52
MCX314
6. Commands for Data Writing
Data writing is used for setting driving parameters such as acceleration, drive speed, output pulse numbers... It is possible to write the same data for more than one axis simultaneously if more those axes are assigned. If the data length is two bytes, WR6 register can be used. If the data is 4 bytes, the high word data can be written into register WR7 and the low word into register WR6. Then, the axis assignment and command code will be written into register WR0 for execution. Writing data for registers WR6 and WR7 is binary and 2' s complement for negatives. Each data should be set within the permitted data range. If the setting data out of range, the driving can not be done. [Note] l It requires 250 nSEC (maximum) to access the command code when CLK=16MHz. Please don' t write the next command or data into WR0 when the present command is written. l Except acceleration offset (OA), the other parameters are unknown while resetting. So, please per-set proper values for those driving related parameters before the driving starts.
www..com
6.1 Range Setting
Data Length 8,000,000(multiple:1)~16,000(multiple:500) 4 bytes Data Range
Code 00
Command Range setting
Symbol R
" R" is the parameter determining the multiple of drive speed, acceleration / deceleration and jerk. The multiple calculation is shown in the following formula: Multiple = 8,000,000 R
For the parameter setting range of drive speed, acceleration / deceleration and jerk is 1~8000, if the higher value is needed, the user should have a larger multiple. In case of increasing the multiple, although the high speed driving is possible, the speed resolution will be decreased. So, the user can set the multiple as small as possible if the setting speed has covered the desired speed. For example, the maximum value of parameter for setting the drive speed (V) is 8000, and the drive speed is set 40KPPS. The user can set V=8000 and R=1,600,000. Because 40K is 5 times of 8000, we set the R=8,000,000/5=1,600,000. The Range (R) can not be changed during the driving. The speed will be changed discontinuously.
6.2 S-curve Acceleration Rate Setting
Code 01h Jerk* setting Command Symbol K 1 ~ 65,535 Data Range Data Length 2
" K" is the parameter determining the increasing / decreasing rate of acceleration / deceleration, in a time unit, of S-curve acceleration / deceleration. The jerk calculation is shown in the following formula: Jerk (PPS/SEC2)= 62.5x106 K x 8,000,000 R Multiple Because the setting range of S-curve acceleration is 1 ~ 65,535, the jerk range is shown as follows: K=65535 K=1 When Multiple = 1, 954 PPS/SEC2 ~ 62.5 x 106 PPS/SEC2 3 2 9 2 When Multiple = 500, 477 x 10 PPS/SEC ~ 31.25 10 PPS/SEC *In this manual, jerk is defined the increasing / decreasing rate of acceleration / deceleration in a time unit. However, jerk should cover the decreasing rate of acceleration and increasing rate of acceleration.
53
MCX314
6.3 Acceleration Setting
Code 02h Command Symbol Data Range Data Length 2 bytes
A Acceleration setting 1 ~ 8,000 " A" is the parameter determining the acceleration or deceleration of the trapezoidal driving. For S-curve acceleration / deceleration (see fig. 2.9, page 7), it shows the linear acceleration until a specific value (A) driving. The acceleration calculation is shown in the following formula: Acceleration (PPS/SEC)= A x 125 x 8,000,000 R Multiple
www..com
For the range of A is from 1 ~ 8,000, the actual acceleration range is shown as follows: A=1 A=8000 When Multiple = 1 125 PPS/SEC ~ 1 x 106 PPS/SEC. When Multiple = 500 62.5 x 103 PPS/SEC ~ 500 x 106 PPS/SEC
6.4 Deceleration Setting
Code 03h Command Deceleration setting Symbol D 1 ~ 8,000 Data Range Data Length 2 bytes
When acceleration / deceleration is set individually (D1 of register WR3 = 1), " D" is the parameter determining the deceleration of the trapezoidal driving. For S-curve acceleration / deceleration, the designated deceleration can be set (see fig 2.9, page 7) until a specific value (D) is driving. The deceleration calculation is shown in the following formula: Deceleration (PPS/SEC)= D x 125 x 8,000,000 R Multiple When acceleration / deceleration is set individually (D1 of register WR3 = 1), the automatic deceleration cannot be performed. The user should use manual deceleration.
6.5 Initial Speed Setting
Code 04h Command Initial speed setting Symbol SV 1 ~ 8,000 Data Range Data Length 2 bytes
" SV" is the parameter determining the speed of constant speed period in trapezoidal driving. The initial speed calculation is shown in the following formula: Initial Speed (PPS)= SV x 125 x 8,000,000 R Multiple For stepper motors, the user should set the initial speed smaller than the self-starting frequency of stepper motors. For servo motors, the recommended setting initial speed is higher than the value of (acceleration). For example, if acceleration / deceleration = 125000 PPS/SEC, the speed setting is better larger than (125000) = 354 PPS.
54
MCX314
6.6 Drive Speed Setting
Code 05h Command Drive speed setting Symbol V 1 ~ 8,000 Data Range Data Length 2 bytes
" V" is the parameter determining the speed of constant speed period in trapezoidal driving. In constant speed driving, the drive speed is the initial speed. The drive speed calculation is shown in the following formula: Drive Speed (PPS)= V x 8,000,000 R Multiple
www..com If the
setting drive speed is lower than the initial speed, the acceleration / deceleration will not be performed, and the driving is constant speed. During the encoder Z-phase searching (at a low-peed driving), if the user want to perform the sudden stop once the Z-phase is detected, the drive speed should be set lower than the initial speed. Drive speed can be altered during the driving. When the drive speed of next constant speed period is set, the acceleration / deceleration will be performed to reach the new setting drive speed, then a constant speed driving starts. [Note] l In fixed pulse S-curve acceleration / deceleration driving, there is no way to change the drive speed during the driving. In continuous S-curve acceleration / deceleration driving, the S-curve profile cannot be exactly tracked if the speed alterations during the acceleration / deceleration. it is better to change the drive speed in the constant speed period. l In fixed pulse trapezoidal driving, the frequent changes of drive speed may occur residual pulses in the ending of deceleration.
6.7 Output Pulse Number / Interpolation Finish Point Setting
Code 06h Command Output pulse number / interpolation finish point setting Symbol P Data Range Output pulse numbers: 0 ~ 268,435,455 Finish point: -8,388,608~+8,388,607 Data Length 2 bytes
Output pulse number setting: The parameter " P" is setting total output pulse numbers in fixed pulse driving. The value is absolute, unsigned number. The output pulse numbers can be changed during the driving. Interpolation finish point setting: This parameter is also setting the finish point of each axis in linear and circular interpolations. The finish points of these axes should be set by relative numbers in 24- bit data length. Output pulse number setting and interpolation finish point setting should be set for 32-bit data length.
6.8 Manual Decelerating Point Setting
Code 07h Command Manual decelerating point setting Symbol DP Data Range 0 ~26 8,435,455 Data Length 4 bytes
" DP" is the parameter setting the manual deceleration point in fixed pulse acceleration / deceleration driving when the manual deceleration mode is engaged. In manual deceleration mode, the user can set the bit D0 of WR3 register to 1. The decelerating point can be set: Manual Decelerating Point = Output Pulse Numbers - Pulse Number for Deceleration
55
MCX314
6.9 Circular Center Setting
Code 08h Command Circular Center setting Symbol C Data Range -8,388,608 ~ +8,388,607 Data Length 4 bytes
" C" is the parameter setting the center point in circular interpolation. The coordinates of center point should be set the relative number related to the current position.
6.10 Logical Position Counter Setting
Code
www..com 09h
Command Logical position counter setting
Symbol LP
Data Range -2,147,483,648 ~ +2,147,483,647
Data Length 4 bytes
" LP" is the parameter setting the value of logic position counter. Logical position counter counts Up / Down according to the +/- direction pulse output. The data writing and reading of logical position counter is possible anytime.
6.11 Real position Counter Setting
Code 0Ah Command Real position counter setting Symbol EP Data Range -2,147,483,648 ~ +2,147,483,647 Data Length 4 bytes
" EP" is the parameter setting the value of real position counter. Real position counter counts Up / Down according to encoder pulse input. The data writing and reading of real position counter is possible anytime.
6.12 COMP+ Register Setting
Code 0Bh Command COMP+ register setting Symbol CP Data Range -2,147,483,648 ~ +2,147,483,647 Data Length 4 bytes
" CP" is the parameter setting the value of COM+ register. COMP+ register is used to compare with logical / real position counter, and the comparison result will be output to bit D0 of register RR1 or nOUT4/CMPP signal. Also, it can be used as the + direction software limit. The value of COMP+ register can be written anytime.
6.13 COMP- Register Setting
Code 0Ch Command COMP- register setting Symbol CM Data Range -2,147,483,648 ~ +2,147,483,647 Data Length 4 bytes
" CM" is the parameter setting the value of COMP- register. COMP- register is used to compare with logical / real position counter, and the comparison result will be output to bit D0 of RR1 register or nOUT5/CMPM signal. Also, it can be used as the - direction software limit. The value of COMP- register can be written anytime.
56
MCX314
6.14 Acceleration Counter Offsetting
Code 0Dh Command Acceleration Counter Offsetting Symbol AO 0 ~ 65,535 Data Range Data Length 4 bytes
" AO" is the parameter executing acceleration counter offset. The offset value of acceleration counter will be set 8 while resetting.
6.15 NOP (Used for Axis Switching)
Code
www..com 0Fh
Command NOP (Used for axis switching)
Symbol
Data Range
Data Length
This command doesn' t execute anything. However, it can be used to assign the accessing axis(axes) according to WR1~3 registers of each axis.
57
MCX314
7. Commands for Reading Data
Data reading commands are used to read the register contents of each axis. After a data reading command is written into register WR0, this data will be set in registers RR6 and RR7. The host CPU can reach the data through reading registers RR6 and RR7. Reading data for registers WR6 and WR7 is binary and 2' s complement for negatives. [Note] l It requires 250 nSEC (maximum) to access the command code when CLK=16MHz. Please read registers RR6 and 7 within this period of time after the present command is written. l The axis assignment is for one axis. If more than one axes are assigned, the data reading priority is X > Y > Z > U.
7.1 Logical Position Counter Reading
www..com
Code 10h
Command Logical position counter reading
Symbol LP
Data Range -2,147,483,648 ~ +2,147,483,647
Data Length 4 bytes
The current value of logical position counter will be set in read registers RR6 and RR7.
7.2 Real position Counter Reading
Code 11h Command Real position counter reading Symbol EP Data Range -2,147,483,648 ~ +2,147,483,647 Data Length 4 bytes
The current value of real position counter will be set in read registers RR6 and RR7.
7.3 Current Drive Speed Reading
Code 12h Command Current drive speed reading Symbol CV 1 ~ 8,000 Data Range Data Length 2 bytes
The value of current drive speed will be set in read registers RR6 and RR7. When the driving stops, the value becomes 0. The data unit is as same as the setting value of drive speed(V).
7.4 Current Acceleration / Deceleration Reading
Code 13h Command Current acceleration / deceleration reading Symbol CA 1 ~ 8,000 Data Range Data Length 2 bytes
The value of current acceleration / deceleration will be set in read registers RR6 and RR7. When the driving stops, the read data is random number. The data unit is as same as the setting value of acceleration(A).
58
MCX314
8. Driving Commands
Driving commands include the commands for each axis' s drive pulse output and other related commands. After the command code and axis assignment are written in command register WR0, the command will be executed immediately. It is possible to assign more than one axis with same command at the same time. In driving, bit n-DRV of each axis' s main status register RR0 becomes 1. When the driving is finished, the bit n-DRV will return to 0. If nINPOS input signal for servo drivers is enabled, bit n-DRV of main status register RR0 will not return to 0 until nINPOS signal is on its active level. [Note] l It requires 250 nSEC (maximum) to access the command code when CLK=16MHz. Please write the next command within this period of time.
8.1 +Direction www..com
Code 20h
Fixed Pulse Driving
Command
+Direction Fixed Pulse Driving
The setting pulse numbers will be output through the output signal nPP. In driving, real position counter will count-up 1 when one pulse is output. Before writing the driving command, the user should set the parameters for the outputting speed curve and the correct output pulse numbers (see the table below). Multiple (R) Constant speed Trapezoidal driving S-curve Acc./Dec. Jerk (K) X X Acceleration Initial Speed Drive Speed Output Pulse (A) X (SV) (V) (P)
8.2 - Direction Fixed Pulse Driving
Code 21h Command -Direction Fixed pulse Driving
The setting pulse numbers will be output through the output signal nPM. In driving, real position counter will count-down 1 when one pulse is output. Before writing the driving command, the user should set the parameters for the outputting speed curve and the correct output pulse numbers.
8.3 +Direction Continuous Driving
Code 22h Command +Direction Continuous Driving
Before the stop command or external signal is active, the pulse numbers will be continuously output through the output signal nPP. In driving, real position counter will count-up 1 when one pulse is output. Before writing the driving command, the user should set the parameters for the outputting speed curve and the correct output pulse numbers.
59
MCX314
8.4 - Direction Continuous Driving
Code 23h Command -Direction Continuous Driving
Before the stop command or external signal is active, the pulse numbers will be continuously output through the output signal nPM. In driving, real position counter will count-down 1 when one pulse is output. Before writing the driving command, the user should set the parameters for the outputting speed curve and the correct output pulse numbers.
8.5 Drive Status Holding
www..com
Code 24h
Command Holding for driving starting
This command is to hold-on the start of driving. When this command is used for starting multi-axis driving simultaneously, the user may write other commands after the drive status holding command is registered. The drive start holding release command (25h) can be written to start the driving. In driving, even this command is written, the driving will not be stopped. The next command will be held.
8.6 Drive Status Holding Release / Finishing Status Clear
Code 25h Command Drive status holding release / finishing status clearing
This command is to release the drive status holding(24h), and start the driving. Also, this command can clear the finishing status bits D15 ~ 8 of register RR1.
8.7 Decelerating Stop
Code 26h Command Decelerating stop in driving
This command performs the decelerating stop when the drive pulses are outputting. If the drive speed is lower than the initial speed, the driving will be suddenly stopped when this command is engaged. In interpolation driving, for main axis, the decelerating stop and sudden stop commands can be written to stop the driving. Once the driving stops, this command will not work.
8.8 Sudden Stop
Code 27h Command Sudden stop in driving
This command performs the sudden stop when the drive pulses are output. Also, the sudden stop can be performed in acceleration / deceleration driving. Once the driving stops, this command will not work. 60
MCX314
9. Interpolation Commands
Interpolation commands consist of the commands for 2 / 3 axes linear interpolation, CW / CCW circular interpolation, 2 / 3 axes bit pattern interpolation and other related commands. There is no need to make the axis assignment in setting bits D11~8 of command register WR0. Please set 0 in those bits. Tow procedures should be follow before the interpolation command is executed: interpolation accessing axes assignment (set-in bits D5~D0 of register WR5) - speed parameter setting for master axis In interpolation driving, bit D8 (I-DRV) of main status register RR0 becomes 1, and will return to 0 when the driving is finished. In interpolation, the n-DRV bit of interpolating axis becomes 1. [Note] l It requires 250 nSEC (maximum) to access the command code when CLK=16MHz. Please write the next command within this period of time.
www..com 9.1 2-Axis
Linear Interpolation
Command 2-axis linear interpolation
Code 30h
This command performs 2-axis interpolation from present point to finish point. Before driving, the finish point of the 2 corresponding axes should be set by incremental value.
9.2 3-Axis Linear Interpolation
Code 31h Command 3-axis linear interpolation
This command performs 3-axis interpolation from present point to finish point. Before driving, the finish point of the 3 corresponding axes should be set by incremental value.
9.3 CW Circular Interpolation
Code 32h Command CW circular interpolation
This command performs 2-axis clockwise circular interpolation, based on center point, from present point to finish point. Before driving, the finish point of the 2 corresponding axes should be set by incremental value. A full circle will come out If the finish position is set (0, 0).
9.4 CCW Circular Interpolation
Code 33h Command CCW circulator interpolation
This command performs 2-axis counterclockwise circular interpolation, based on center point, from present point to finish point. Before driving, the finish point of the 2 corresponding axes should be set by incremental value. A full circle will come out If the finish position is set (0, 0).
9.5 2-Axis Bit Pattern Interpolation
61
MCX314 Code 34h Command 2-axis bit pattern interpolation
This command performs 2-axis bit pattern interpolation. Before driving, the +/- direction bit data of the two interpolating axes should be set, and the setting bit data of each axis (each direction) is at most 16 N= 48-bit. Once the data is over than 48-bit, those remaining 3 data can be filled during the driving.
9.6 3-Axis Bit Pattern Interpolation Drive
Code 35h
www..com
Command 3-axis bit pattern interpolation
This command performs 3-axis bit pattern interpolation. Before driving, the +/- direction bit data of the two interpolating axes should be set, and the setting bit data of each axis (each direction) is at most 16 N= 48-bit. Once the data is over than 48-bit, those remaining 3 data can be filled during the driving.
9.7 BP Register Data Writing Enabling
Code 36h Command BP register data writing enabling
This command enables the bit pattern data writing registers BP1P/M, BP2P/M and PB3P/M. After this command is issued, the data writing to register nWR2~nWR5 becomes disabled. The data written to the bit pattern data writing registers is disabled while resetting.
9.8 BP Register Data Writing Disabling
Code 37h Command BP register data writing disabling
This command disables the bit pattern data writing registers BP1P/M, BP2P/M and PB3P/M. After this command is issued, the data writing to register nWR2~nWR5 becomes enabled.
9.9 BP Data Stack
Code 38h Command BP data stacking
This command stacks the data of bit pattern data writing registers BP1P/M, BP2P/M, and BP3P/M. After this command is issued, stack counter (SC) will plus 1. When stack counter (SC) is 3, this command cannot be issued again.
62
MCX314
9.10 BP Data Clear
Code 39h Command BP data clearing
This command clears all the bit pattern data, and sets the stack counter (SC) to 0.
9.11 Single Step Interpolation
Code
www..com
Command Single step interpolation
3Ah
This command performs 1-pulse (each step) output in interpolation driving. When D12 bit of register WR5 is set 1, the single step interpolation can be performed. After this command is issued, single step interpolation starts.
9.12 Deceleration Enabling
Code 3Bh Command Deceleration enabling
This command enables the automatic and manual decelerations. In case of the individual interpolation, the user can issue this command before the driving. However, in continuous interpolation, the user should disable the deceleration than start the driving. This command should be put in the final node, and written before the interpolation command of the final node is written. If each axis has to decelerate individually, execute this command before driving. But for continuous interpolation, disable the deceleration first and enable it until the last node. The deceleration is disabled while resetting. When the deceleration enabling command is issued, the enabling status is kept until the deceleration disabling command (3C) is written, or the reset happens. Deceleration enabling / disabling is active in interpolation; automatic and manual decelerations are always active when individual axis is in driving.
9.13 Deceleration Disabling
Code 3Ch Command Deceleration disabling
This command disables the automatic or manual deceleration in interpolation.
9.14 Interpolation Interrupt Clear
Code 3Dh Command Interpolation interrupt clear
This command clears the interrupt in bit pattern or continuous interpolation. After the bit D15 of WR5 is set to 1 in bit pattern interpolation, the stack counter (SC) is changed from 2 to 1, and the interrupt will be generated. In continuous interpolation, when the bit D14 of WR5 is set to 1, the interrupt will be generated when it is ready to write the interpolation data for next node.
63
MCX314
10. Connection Examples
10.1 Connection Example for 68000 CPU
68000 MCX314 CLK RDN R/W UDS Or LDS D15~D0 A3 A2 A1 WRN
Clock generator
16MHz
pull up resistance
D15~D0 A2 A1 A0 +5V G 74LS348 CSN
Add. decoder
www..com A23~A4
AS DTACK IPL2 IPL1 IPL0 A2 A1 A0 7 O.C
+5V INTN
1 0 E1 +5V 74LS138 G G G FC2 FC1 FC0 VPA C B A
+5V Y7
+5V
H16L8 RESETN
O.C
form system reset signal
10.2 Connection Example for Z80 CPU
Z80
Clock generator
16MHz
MCX314 CLK RDN WRN
__ RD __ WR __
10RQ A7 A6 A5 A4 A3 A2 A1 A0 D7~D0 74LS139
_
a
B A
_ _ Y1 _ Y2 _
Y0 Y3
CSN
A3 A2 A1 A0 D7~D0
Pull up resistance
D15~D8
H16L8 +5V
__
INT
INTN
from system reset signal
RESETN
64
MCX314
10.3 Connection Example
The figure shown below illustrates the example of 1-axis driving system. 4 axes can be assigned in the same way.
Stepper/servo Encodermotor EC M -Limit Home Close to home +Limit
CW pulse CCW pulse Error counter clear Servo on
www..com EC-A,B,Z
I/F
XPP XPW XOUT0 XOUT1 XIN3 XINPOS XALARM XECA/B,XIN2
MCX 314 1/4
XLMTP XLMTM I/F XIN0 XIN1 XEXPP I/F XEXPW
Motor drives
SERVO READY Positining complete Alarm EC-A/B,Z
I/F
10.4 Pulse Output Interface
n Output to Motor Drivers in Differential Circuit
MCX314
CW+
Motor Drives
+
XPP Am26L31
CW -
-
CCW+
Am26L32
+ -
XPM
CCW -
Twist Pair Shield Cable
GND
n Open Collector TTL Output
MCX314 +5V CW+ CW Motor Drives
XPP
+5V
CCW+ CCW -
XPM 72LS06 GND
Twist Pair Shield Cable
For drive pulse output signals, we recommend the user to use twist pair shield cable due to the concern of EMC.
65
MCX314
10.5 Connection Example for Input Signals
In MCX314, except (D15 ~ D0), all the input signals are internal pull high and buffered by Smith trigger.
MCX314
+5V 3.3k 0.01 TLP121 10k 3.3k +12~24V
The response time of this loop is about 0.2 ~ 0.4 mSEC.
www..com
10.6 Connection Example for Encoder
The following diagram is the example for the encoder signal which is differential line-drive output, Then, this signal can be received through the high speed photo coupler IC which can direct it to MCX314.
MCX314
+5V 220 XECA 470 1k ECA+ ECA-
66
MCX314
11. Example Program
The example C program for MCX314 can complied by Turbo C++ 4.0 and the operation system DOS/V.
#include #include // -----MCX314 register address definition ----#define adr 0x280 //Basic address #define wr0 0x0 //Command register #define wr1 0x2 //Mode register 1 #define wr2 0x4 //Mode register 2 #define wr3 0x6 //Mode register 3 #define wr4 0x8 //Output register #define wr5 0xa //Interpolation mode register #define wr6 0xc //Low word bits data writing register #define wr7 0xe //High word bits data writing register a outpw(adr+wr6, wdata); outpw(adr+wr0, (axis<<8) + 0x01); b // acc(axis assignment, data) -----For acceleration/deceleration (A) setting void acc(int axis, long wdata) a outpw(adr+wr6,wdata); outpw(adr+wr0, (axis<<8) + 0x02); b // dec( axis assignment, data) -----For deceleration (D) setting void dec(int axis, long wdata) a outpw(adr+wr6, wdata); outpw(adr+wr0, (axis<<8) + 0x03); b // startv(axis assignment, data) -----For initial speed (SV) setting void startv(int axis, long wdata) a outpw(adr+wr6, wdata): outpw(adr+wr0, (axis<<8) + 0x04); b // speed(axis assignment, data) -----For drive speed (V) setting void speed(int axis, long wdata) a outpw(adr+wr6, wdata); outpw(adr+wr0, (axis<<8) + 0x05); b // pulse( axis assignment, data) -For output pulse output/finish point (P) setting void pulse(int axis, long wdata) a outpw(adr+wr7, (wdata>>16) & 0xffff); outpw(adr+wr6, wdata & 0xffff); outpw(adr+wr0, (axis<<8) +0x06); b // decp(axis assignment, data) -----For manual deceleration (DP) setting void decp(int axis, long wdata) a outpw(adr+wr7, (wdata>>16) & 0xffff); outpw(adr+wr6, wdata & 0xffff); outpw(adr+wr0, (axis<<8) + 0x07); b // center(axis assignment, data) -----For circular center point (C) setting void center(int axis, long wdata) a outpw(adr+wr7, (wdata>>16) & 0xffff); outpw(adr+wr6, wdata & 0xffff); outpw(adr+wr0, (axis<<8) + 0x08); b // lp(axis assignment, data) -----For logical position counter (LP ) setting void lp(int axis, long wdata) a outpw(adr+wr7, (wdata>>16) & 0xffff); outpw(adr+wr6, wdata & 0xffff); outpw(adr+wr0, (axis<<8) + 0x09); b // ep(axis assignment, data) -----For real position counter (EP) setting void ep(int axis, long wdata) a outpw(adr+wr7, (wdata>>16) & 0xffff); outpw(adr+wr6, wdata & 0xffff); outpw(adr+wr0, (axis<<8) + 0x0a); b // compp(axis assignment, data) -----For COMP+ (CP) setting
www..com #define rr0 #define rr1 #define rr2 #define rr3 #define rr4 #define rr5 #define rr6 #define rr7
#define control #define control #define control #define control #define control #define control
0x0 0x2 0x4 0x6 0x8 0xa 0xc 0xe
//Main status register //Status register 1 //Status register 2 //Status register 3 //Input register 1 //Input register 2 //Low word bits data reading register //High word bits data reading register //BP + direction data register for the first axis //BP - direction data register for the first axis //BP + direction data register for the second axis //BP - direction data register for the second axis //BP + direction data register for the third axis //BP - direction data register for the third axis
bp1p 0x4 bp1m 0x6 bp2p 0x8 bp2m 0xa bp3p 0xc bp3m 0xe
// wreg 1 (axis assignment, data) ----Write register 1 setting void wreg1(int axis, int wdata) a outpw(adr+wr0,(axis<<8)+0xf); //axis assignment outpw(adr+wr1, wdata); b // wreg 2 (axis assignment, data) ----Write register 2 setting void wreg2 (int axis, int wdata) a outpw(adr+wr0,(axis<<8)+0xf); //axis assignment outpw(adr+wr2, wdata); b // wreg 3 (axis assignment, data) -----Write register 3 setting void wreg3(int axis, int wdata) a outpw(adr+wr0, (axis<<8)+0xf); //axis assignment outpw(adr+wr3, wdata); b // command (axis assignment, data) -----For writing commands void command(int axis, int cmd) a outpw(adr+wr0, (axis<<8)+cmd): b // range(axis assignment, data) -----For range (R) setting void range(int axis, long wdata) a outpw(adr+wr7,(wdata>>16) & 0xffff); outpw(adr+wr6, wdata & 0xffff); outpw(adr+wr0, (axis<<8) + 0x00); b // acac(axis assignment, data) -----For S-curve acceleration (K) setting void acac(int axis, long wdata)
67
MCX314
void compp(int axis, long wdata) a outpw(adr+wr7, (wdata>>16) & 0xffff); outpw(adr+wr6, wdata & 0xffff); outpw(adr+wr0, (axis<<8) + 0x0b); b // compm(axis assignment, data) -----For COMP- (CM) setting void compm(int axis, long wdata) a outpw(adr+wr7, (wdata>>16) & 0xffff); outpw(adr+wr6, wdata & 0xffff); outpw(adr+wr0, (axis<<8) + 0x0c); b // accofst(axis assignment, data) ----For acceleration counter shift (AO) setting void accofst(int axis, long wdata) a www..com outpw(adr+wr7, (wdata>>16) & 0xffff); outpw(adr+wr6, wdata & 0xffff); outpw(adr+wr0, (axis<<8) + 0x0d); b // readlp(axis assignment) -----For logical position counter (LP) reading void readlp(int axis) a long a;long d6;long d7; outpw(adr+wr0, (axis<<8) + 0x10); d6=inpw(adr+rr6);d7=inpw(adr+rr7); a=d6 + (d7<<16); return(a); b // readep(axis assignment) -----For real position counter (EP) reading void readep(int axis) a long a;long d6;long d7; outpw(adr+wr0, (axis<<8) + 0x11); d6=inpw(adr+rr6);d7=inpw(adr+rr7); a=d6 + (d7<<16); return(a); b // wait(axis assignment) -----For waiting for drive stop void wait(int axis) a while(inpw(adr+rr0) & axis); b // next_wait() -----Next data setting of waiting for continuous interpolation void next_wait(void) a while((inpw(adr+rr0) & 0x0200)==0x0); b // bp_wait() ----- Next data setting of waiting for BP interpolation void bp_wait(void) a while((inpw(adr+rr0) & 0x06000)= =0x6000); b // homesrch()-----for homeal point searching on whole axis void homesrch(void) a // [Action] The same for (1) ~ (3) axes wreg1(0xf, 0x0008); // If homeal signal (in 1) = OFF speed(0xf, 2000); // -direction motion will be continuously driven at a speed of 20000 PPS if((inpw(adr+rr4) & 0x2)= =0x2) // If IN1 signal = ON, deceleration will be stopped. a command(0x1, 0x23); b if((inpw(adr+rr4) & 0x200)= =0x200) a command(0x2, 0x23); b if((inpw(adr+rr5) & 0x2)= =0x2 a command(0x4, 0x23); b if((inpw(adr+rr5) & 0x200)= =0x200) a command(0x8, 0x23); b wait(0xf); wreg1(0xf, 0x000c); //(2) + direction motion will be continuously driven at a speed of 500 PPS speed(0xf, 50); //When IN1 = OFF, it will be suddenly stopped command(0xf, 0x21); wait(0xf); wreg1(0xf, 0x0000); //(3) - direction motion will be driven at a speed of 40000 PPS speed(0xf, 40000); //100-pulse shift pulse(0xf, 100); command(0xf, 0x21); wait(0xf); lp(0xf, 0); //(4) LP = 0 for X, Y, Z, and U axes wreg2(0xf, 0x0003); //Software limit on X, Y, Z axes: ON compp(0x1, 100000); //X: -1000 ~ +100000 compm(0x1, -1000); compp(0x2, 50000); //Y: -500 ~ +50000 compm(ox2, -500); compp(0x4, 10000); //Z: -100 ~ +10000 compm(0x4, -100); //***********<
>************** void main(void) a int count; outpw(adr+wr0, 0x8000); //Software reset for(count = 0; count<2; ++count); command(0xf, 0xf); outpw(adr+wr1, 0x0000); 00000000 00000000 outpw(adr+wr2, 0x0000); 00000000 00000000 outpw(adr+wr3, 0x0000); 00000000 00000000 outpw(adr+wr4, 0x0000); 00000000 00000000 outpw(adr+wr5, 0x0024); 00000000 00100100 //-----Whole axis mode setting-------//Mode register 1 : //Mode register 2 : //Mode register 3 : //General output register //Interpolation mode register
//-----Initial value settings for whole axis driving accofst(0xf,0); //AO = 0 range(0xf, 800000) //R = 800000 (Multiple = 10) acac(0xf, 1010); //K = 1010 (Jerk = 619 KPPS/SEC2) acc(0xf, 100); //A = 100 (Acceleration/deceleration=125 KPPS/SEC) dec(0xf, 100); //D (Deceleration = 125 KPPS/SEC) startv(0xf, 100); //SV = 100 (Initial Speed = 1000 PPS) speed(0xf, 4000); //V = 40000 (Drive Speed = 40000 PPS) pulse(0xf, 100000); //P = 100000 (output pulse number = 100000) lp(0xf, 0); //LP = 0 (Logical position counter = 0) homesrch( ); //-----Home searching on whole axis-----
//-----Trapezoidal driving at X and Y axes acc(0x3, 200); (Acceleration/deceleration = 250KPPS/SEC) speed(0x3, 4000); //V = 4000(Drive Speed = 4000 PPS)
68
MCX314
pulse(0x1, 8000); //xP = 8000 pulse(0x2, 40000); //yP = 40000 command(0x3, 0x20); //- direction constant drive wait(0x3); //Wait for drive stop wreg3(0x3, 0x0004); //S-curve acceleration/deceleration driving at X and Y axes acac(0x3, 1010); //K = 1010 (S-curve Acceleration = 619 KPPS/SEC2) acc(0x3, 200); //A = 200 (Acceleration/Deceleration = 250 KPPS/SEC) speed(0x3, 4000); //V = 4000 (Drive Speed = 4000 PPS) pulse(0x1, 50000); //xP = 50000 pulse(0x2, 25000); //yP = 25000 command(0x0, 0x21); //- direction constant drive wait(0x3); wreg3(0x3, 0x0000); //S-curve acceleration/deceleration mode clearing //-----Linear interpolation drive at X and Y axis outpw(adr+wr5, 0x0124); //ax1 = x, ax2 = y, ax3 = z, linear speed keeps constant range(0x1, 800000); //ax1/R = 800000 (Multiple = 10) range(0x2, 1131371); //ax1/R = 800000 x 1.414 speed(0x1, 100); //Drive Speed = 1000 PPS constant speed pulse(0x1, 5000); //xP = +5000 (Finish point X = +5000) pulse(0x2, -2000); //yP = -2000 (Finish point Y = -2000) command90x0, 0x30); // 2-axis linear interpolation wait(0x3) //-----Circular interpolation drive at X and Y axes ----outpw(adr+wr5, 0x0124); //ax1 = x, ax2 = y, ax3 = z, linear speed keeps constant range(0x1, 800000); //ax1/R = 800000 (Multiple = 10) range(0x2, 1131371); //ax2/R = 800000 x 1.414 speed(0x1, 100); //Drive Speed = 1000 PPS constant speed center(0x1, -5000); //xC = 5000 (Center of X = -5000) center(0x2, 0); //yC = 0 (Center of Y = 0) pulse(0x1, 0); //xP = 0 (Finish point of X = 0) Circle pulse(0x2, 0); //yP = 0 (Finish point of Y = 0) command(0x0, 0x33); //CCW circular interpolation wait(0x3); //----- Bit pattern interpolation at X and Y axes-----//(Example of figure 2.24) speed(0x1,1); //Drive Speed = 10 PPS constant speed command(0, 0x36); //Bit pattern data writing permission outpw(adr+bp1p, 0x0000); //0 ~ 15 bits data writing outpw(adr+bp1m, 0x2bff); outpw(adr+bp2p, 0xffd4); outpw(adr+bp2m, 0x0000); command(0, 0x38); //Stack outpw(adr+bp1p, 0xf6fe); //16 ~ 31 bits data writing outpw(adr+bp1m, 0x0000); outpw(adr+bp2p, 0x000f); outpw(adr+bp2m, 0x3fc0); command(0, 0x38); outpw(adr+bp1p, 0x1fdb); //32 ~ 47 bits data writing outpw(adr+bp1m, 0x0000); outpw(adr+bp2p, 0x00ff); outpw(adr+bp2m, 0xfc00); command(0, 0x38); command(0, 0x38); bp_wait( ); //2-axis BP interpolation drive starting //Wait for data writing command(0,0x37); wait(0x3); // Bits pattern data writing inhibition //Wait for drive stop
//----- Continuous interpolation at X and Y axes (Example of figure 2.29) speed(0x1, 100); //Drive Speed = 10 PPS constant speed pulse(0x1, 4500); pulse(0x2, 0); command(0, 0x30); next_wait(); center(0x1,0); center(0x2, 1500); pulse(0x1, 1500); pulse(0x2, 1500); command(0, 0x33); next_wait(); pulse(0x1, 0); pulse(0x2, 1500); command(0, 0x30); next_wait(); center(0x1, -1500); center(0x2, 0); pulse(0x1, -1500); pulse(0x2, 1500); command(0, 0x33); next_wait(); pulse(0x1, -4500); pulse(0x2, 0); command(0, 0x30); next_wait(); center(0x1, 0); center(0x2, -1500); pulse(0x1, -1500); pulse(0x2, -1500); command(0, 0x33); next_wait(); pulse(0x1, 0); pulse(0x2, -1500); command(0, 0x30); next_wait(); center(0x1, 1500); center(0x2, 0); pulse(0x1, 1500); pulse(0x2, -1500); command(0, 0x33); wait(0x3); b // node 1
//Wait for next data setting // node 2
wat wtm w. D S .h a 4 U c o e
// node 3
// node 4
// node 5
// node 6
//node 7
//node 8
outpw(adr+bp1p, 0x1fdb); //48 ~ 63 bit3 data writing outpw(adr+bp1m, 0x0000); outpw(adr+bp2p, 0x00ff); outpw(adr+bp2m, 0xfc00); command(0, 0x38);
69
12. Electrical Characteristics
12.1 DC Characteristics
n Absolute Maximum Rated Item Symbol Value Power Voltage VDD -0.3 ~ +7.0 Input voltage Input Current Reservation Temperature VIN IIN TSTG -0.3 ~ VDD+0.3 10 -40 ~ +125 Unit V V mA C n Recommend Operation Environment Item Symbol Value Power Voltage VDD 4.75 ~ 5.25
Ambient Temperature
Unit V C
Ta
0 ~ +85
If the user wishes to operate the IC below 0C, please make contact with our R&D engineer.
n DC Characteristics www..com
Item Mark High level input voltage VIH Low level input voltage VIL High level input current IIH Low level input current High level output voltage IIL Condition
(Ta = 0 ~ +85C, VDD = 5V O 5%)
Min. 22 -10 -10 -200 VDD-0.05 2.4 2.4 0.05 0.4 0.4 10 0.3 52 90 Typ. Max. 0.8 10 10 -10 Unit V V A A A V V V V V V A V mA D15~D0 Input signal Input signal besides D15~D0 Note 1 Output Signal besides D15~D0 D15~D0 Output signal Output signal besides D15~D0 D15~D0 output signal D15~D0, BUSYN, INTN Remark
VIN=VDD VIN=0V VIN=0V IOH=-1A IOH=-4 mA
VOH IOH=-8 mA IOL=1A IOL=4 mA IOL=8 mA VOUT=VDD or 0V IIO=0 mA, CLK=16 MHz
Low level output voltage Output leakage current
VOL
IOZ Smith hysteresis voltage VH Consuming current IDD
-10
Note1 : BUSYN and INTN output signals have no items for high level output voltage due to the open drain output. n Pin Capacity
Item Input/ Output capacity Input capacity Mark CIO CI Condition Ta=25C f=1 MHz Min. Typ. Max. 10 10 Unit Remark pF D15 ~ D0 pF Other input pins
12.2 AC Characteristics
12.2.1 Clock
n CLK Input Pulse
(Ta = 0 ~ +85C, VDD = 5V 5%, Output load condition: 85 pF + 1 TTL )
n SCLK Output Signal
CLK
CLK
tWH tCYC
tWL
SCLK tDR tDF
SCLK will not be output during reset. Symbol tCYC tWH tWL tDR tDF Item CLK Cycle CLK Hi Level Wavelength CLK Low Level Wavelength CLK SCLK Delay Time CLK SCLK Delay Time Min. 62.5 20 20 Max. Unit nS nS nS nS nS
21 23
MCX314
12.2.2 Read / Write Cycle
Read cycle
Valid Address
Write cycle
Valid Address
Data output. tCR
www..com
Data input. tCW tAW tWW tDW tDH tWC tWA
tRD
tDF tRC tRA
tAR
The figure shown above is used for 16-bit data bus accessing (H16L8 = Hi). For 8-bit data bus (H16L8 = Low), the address signals shown in the figure become A3~A0, and data signals become D7~D0.
Symbol tAR tCR tRD tDF tRC tRA tAW tCW tWW tDW tDH tWC tWA
Item Address SETUP Time CSN SETUP Time Output Data Delay Time Output Data Reservation Time CSN Reservation Time Address Reservation Time Address SETUP Time Established Time for CSN (to RDN ) (to RDN ) (from RDN ) (from RDN ) (from RDN ) (from RDN ) (to WRN )
Min. 0 0
Max.
Unit nS nS nS nS nS nS nS nS nS nS nS nS nS
29 0 0 0 0 0 50 30 10 5 5 30
(to WRN ) WRN Low Level Wavelength Established Time for Input Data (to WRN ) Reservation Time for Input Data (from WRN ) CSN Reservation Time Address Reservation Time (from WRN ) (from WRN )
12.2.3 BUSYN Signal
tDF
tWL
It is low when BUSYN is active. And BUSYN is low after 2 SCLK cycles when WRN active.
Mark tDF tWL Item WRN BUSYN Delay Time BUSYN Low Level Wavelength Min. Max. 32 tCYC x 4+30 tCYC is a cycle of CLK. Unit nS nS
12.2.4 SCLK/Output Signal Timing
The following output single is synchronized with SCLK output signal. The level at ACLK will be changed. Output signals : nPP/PLS, nPM/DIR, nDRIVE, nASND, nDSND, nCMPP, and nCMPM.
71
MCX314
SCLK Output signal tDI
Mark tDD
Item SCLK Output Signal Delay Time
Min. 0
Max. 20
Unit nS
12.2.5 Input Pulses
n Quadrature Pulses Input Mode (A/B phases)
Counting up nECA nECB
www..com
tDE tDE tDE tDE tDE tDE tDE tDE
Counting down
n Up/Down Pules Input Mode
nPPIN nPMIN
tDE tICYC tDE tIB tDE tICYC tDE
l In A/B quadrature pulse input mode, when nECA and nECB input pulses are changed, the value of real position counter will be changed to the value of those input pulses changed after the period of longest SCLK4 is passed. l In UP/DOWN pulse input mode, the real position counter will become the value of those input pulses changed, after the period between the beginning of nPPIN, nPMIN and the time of SCLK 4 cycle is passed.
Mark tDE tIH tIL tiCYC tIB Item nECA and nECB Phase Difference Time nPPIN and nPMIN Hi Level Wavelength nPPIN and nPMIN Low Level Wavelength nPPIN and nPMIN Cycle nPPIN nPMIN Time Min. tCYC x 2+20 30 30 tCYC x 2+20 tCYC x 2+20 Max. Unit nS nS nS nS nS
12.2.6 General Purpose Input / Output Signals
The figure shown at the lower left hand side illustrates the delay time when input signals nIN3 ~ 0, nEXPP, nEXPM, nINPOS, and nALARM are read through RR4 and RR5 registers. The figure shown at the lower right hand side illustrates the delay time when writing general output signal data into nWR3 and nWR4.
Input signal RDN D15~0 tDI WRN D15~0 nOUT7~0 tDO
Mark tDI tDO
Item Input Signal Data Delay Time WRN nOUT7~0 Established Time
Min.
Max. 32 32
Unit nS nS
72
MCX314
13. Timing of Input / Output Signals
13.1 Power-On Reset
VDD CLK RESETN SCLK BUSYN
www..com
nPP/PLS nPP/DIR nDRIVE nOUT7~0
INTN
The reset signal input to pin RESETN will keep on the Low level for at least 4 CLK cycles. - When RESETN is on the Low level for 4 CLK cycles maximum, the output signals of MCX314 are decided. (R) SCLK will be output after 2 CLK cycles when RESTN return to the Hi level. BUSYN keeps on the Low level for 8 CLK cycles when RESTN is on the Hi level.
13.2 Fixed Pulse or Continuous Driving
SCLK WRN BUSYN Drive command write in
nPP, nPM, nPLS
1st pulse
2nd pulse
The final pulse
nDIR nDRIVE nASND, nDSND
Pre-state
valid level
valid level
This first driving pulses (nPP, nPM, and nPLS) will be output after 3 SCLK cycles when BUSYN is . - The nDIR (direction) signal is valid after 1 SCLK cycle when BUSYN is . (R) The dDRIVE becomes Hi level when BUSYN is . The nASND and nDSND are on invalid level after 3 SCLK cycles when BUSYN is .
73
MCX314
13.3 Interpolation
SCLK WRN BUSYN nPP, nPM, nPLS nDIR * 1st pulse valid level invalid 2nd pulse valid level invalid
invalid
nDRIVE
www..com
The first pulses (nPP, nPM, and nPLS) of interpolation driving will be output after 4 SCLK cycles when BUSYN is . - nDRIVE will become Hi level after 1 SCLK cycle when BUSYN is . (R) DIR signal keeps the active level in 1 SCLK cycle before and after the Hi level pulse outputting.
13.4 Start Driving after Hold Command
SCLK WRN BUSYN
nPP, nPM, nPLS
1st pulse
2nd pulse
nDRIVE
The pulses (nPP, nPM, and nPLS) of each axis will start outputting after 3 SCLK cycles when BUSYN is . - nDRIVE will become Hi level when BUSYN is for each axis.
13.5 Sudden Stop
The following figure illustrates the timing of sudden stop. The sudden stop input signals are EMGN, nLMTP/M (When the sudden stop mode is engaged), and nALARM. When sudden stop input signal becomes active, or the sudden stop command is written, it will stop the output of pulses immediately. The width of external signals input for sudden stop must be more than 1 SCLK cycle. The stop function will not be active if the width is less 1 SCLK cycle.
SCLK Decelerating signal Decelerating command write in active
nPP, nPM, nPLS nDSND
13.6 Decelerating Stop
The following figure illustrates the timing of decelerating stop input signal and decelerating commands. The decelerating stop signal are nIN3 ~ 0 and nLMTP/M (When the decelerating mode is engaged) 74
MCX314 When speed decelerating signals become active, or the decelerating stop command is written, the decelerating stop function will be performed.
Decelerating signal Decelerating command write in active
nPP, nPM, nPLS nDSND
www..com
75
MCX314
14. Pinout
Unit: mm
www..com
76
MCX314
15. Specifications
n Control Axis n Data Bus 4 axes 16/8 bits selectable
Interpolation Functions
n 2-axes / 3-axes Linear Interpolation Interpolation Range Interpolation Speed Interpolation Accuracy n Circular Interpolation Interpolation Range www..com Interpolation Speed Interpolation Accuracy Each axis -8,388,608 ~ +8,388,607 1 ~ 4 MPPS 0.5 LSB (Within the range of whole interpolation)
Each axis -8,388,608 ~ +8,388,607 1 ~ 4 MPPS 1 LSB (Within the range of whole interpolation)
n 2 axes / 3 axes Bit Pattern Interpolation Interpolation Speed 1 ~ 4 MPPS (Dependent on CPU data writing time) n Related Functions of Interpolation lCan select any axis lConstant vector speed lContinuous interpolation lSingle step interpolation (Command/external signals)
Common Specifications of Each Axis
n Drive Pulses Output (When CLK = 16 MHz) Pulse Output Speed Range 1PPS ~ 4MPPS Pulse Output Accuracy within 0.1% (according to the setting speed) S-curve Jerk 954 ~ 31.25 N 9PPS/S2 10 Accelerating / Decelerating Speed 125 ~ 500 N 6PPS/S 10 Drive Speed 1 ~ 4 N 6 PPS 10 Output-pulse Number 0 ~ 268435455 / unlimited Speed Curve quadrature / trapezoidal / parabolic S-curve Index Drive Deceleration Mode auto / manual Output-pulse numbers and drive speeds changeable during the driving Independent 2-pulse system or 1-pulse 1-direction system selectable Logical levels of pulse selectable n Encoder Input A/B quadrature pulse style or Up/Down pulse style selectable Pulse of 1, 2 and 4 divisions selectable (A/B quadrature pulse style) n Position Counter Logic Position Counter (for output pulse t) range Real Position Counter (for feedback pulse) range Data read and write possible
-2,147,483,648 ~ +2,147,483,647 -2,147,483,648 ~ +2,147,483,647
77
MCX314 n Comparison Register COMP + Register Position comparison range -2,147,483,648 ~ +2,147,483,647 COMP - Register Position comparison range -2,147,483,648 ~ +2,147,483,647 Status and signal outputs for the comparisons of position counters Software limit functioned n Interrupt (Interpolations Excluded) The factors of occurring interrupt: ..the drive-pulse outputting ..the start / finish of a constant-speed drive during the acceleration / deceleration driving ..the end of the driving ..the volume of position counter U volume of COMPthe ..the volume of position counter O volume of COMPthe www..com ..the volume of position counter U volume of COMP+ the ..the volume of position counter O volume of COMP+ the Enable / disable for these factors selectable n External Signal for Driving EXPP and EXPM signals for fixed pulse / continuous drive n External Deceleration / Sudden Stop Signal IN0 ~ 3 4 points for each axis Enable / disable and logical levels selectable n Servo Motor Input Signal ALARM (Alarm) INPOS (In Position Check) Enable / disable and logical levels selectable n General Output Signal OUT0 ~ 7 8 points for each axis (wherein 4 points use with drive status output signal pin) n Driving Status Signal Output ASND (speed accelerating), DSND (speed decelerating), CMPP (position U COMP+), CMPM (position O COMP-) Drive status and status registers readable n Limit Signals Input 2 points, for each + and - side Logical levels and decelerating / sudden stop selectable n Emergency Stop Signal Input EMG, 1 point for 4 axes n Electrical Characters Temperature Range for Driving Power Voltage for Driving Input / Output Signal Level Input Clock Pulse n Package
0 ~ +45C (32F ~185F) 5V 5 % (max. power consumption: 90mA) CMOS, TTL connectable 16,000 MHz (Standard) 144-pin plastic QFP, pitch = 0.65mm Dimension : 30.9 x 30.9 x 4.36 mm
78
MCX314
Appendix A: Speed Curve Profile
The following curves are based on the test records from MCX314 output drive pulses and speed curve traces. The complete S-curve acceleration / deceleration is the curve drive, without linear acceleration / deceleration, before the appointed drive speed is reached. Partial S-curve acceleration / deceleration is with a period of linear acceleration / deceleration before the appointed drive speed is reached.
n 40KPPS Full S-curve Acceleration / Deceleration R=800000 (Rate:10), K=700, A=D=200, SV=100, V=4000, A0=50 Auto Decelerating Mode 2 Jerk=893KPPS/ SEC Accel. / Decel. =250KPPS/SEC Initial Speed=1000PPS www..com Drive Speed=40KPPS Output Pulse P=50000 n 40KPPS Partial S-curve Acceleration / Deceleration R=800000 (Rate:10), K=300, A=D=150, SV=100, V=4000, A0=20 Auto Decelerating Mode 2 Jerk=2083KPPS/ SEC Accel. / Decel. =188KPPS/SEC Initial Speed=1000PPS Drive Speed=40KPPS Output Pulse P=50000
1
MCX314
n 8000PPS complete S-curve Acceleration / Deceleration R=8000000 (Rate:1), K=2000, A=D=500, SV=100, V=8000, A0=0 Auto Decelerating Mode Jerk=31KPPS/ SEC Accel. / Decel. =62.5KPPS/SEC Initial Speed=100PPS Drive Speed=8000PPS Output Pulse P=20000 Output Pulse P=20000
2
n 8000PPS Partial S-curve Acceleration / Deceleration R=800000 (Rate: 1), K=1000, A=D=100, SV=100, V=8000, A0=0 Auto Decelerating Mode Jerk=62.5KPPS/ SEC Accel. / Decel. =12.5KPPS/SEC Initial Speed=100PPS Drive Speed=8000PPS
2
www..com
n 400KPPS Full S-curve Acceleration / Deceleration R=80000(Rate:100),K=2000,A=D=100,SV=10,V=4000, A0=1000 Auto Decelerating Mode Jerk=3.13MPPS/SEC Accel. / Decel. =1.25MPPS/SEC Initial Speed=1000PPS Drive Speed=400KPPS Output Pulse P=400000
2
n 400KPPS Partial S-curve Acceleration / Deceleration R=80000 (Rate: 100), K=500, A=D=100, SV=10, V=4000, A0=0 Auto Decelerating Mode Jerk=12.5MPPS/ SEC Accel. / Decel. =1.25MPPS/SEC Initial Speed=1000PPS Drive Speed=400KPPS Output Pulse P=400000
2
2
MCX314
n Speed Alterations in a Continuous S-curve Acceleration / Deceleration Drive R=800000 (Rate: 10), K=2000, A=D=100, SV=100, V=1000 / 2000 / 4000 / decelerating stop Jerk=312.5KPPS/ SEC Jerk(decel.)=125KPPS/SEC Initial Speed=1000PPS Drive Speed=10K / 20K / 40KPPS
2
n 40KPPS Linear Acceleration / Deceleration
n Triangle wave Avoiding during the Linear Acceleration / Deceleration When K=1 (Jerk: Maxium) in the S-curve Accel./ Decel. Mode, " 1/4 output pulses" principle can be engaged. Even the output pulses are few, the drive is a trapezoidal drive. R=800000 (Rate: 10), K=1, A=D=100, SV=100, V=4000 WR3/D2, D1, D0=1, 0, 0 S-curve Mode, Auto Decelerating Mode Jerk =625MPPS/ SEC Accel./ Decel. =125KPPS/SEC Initial Speed=1000PPS Drive Speed=40000PPS Output Pulse P=40000
2
www..com
R=800000 (Rate: 10), A=D=100, SV=100, V=4000 WR3/D2, D1, D0=0, 0, 0 Trapezoidal Mode, Auto Decelerating Mode Accel./ Decel. =125KPPS/ SEC Initial Speed=100PPS Drive Speed=40000PPS Output Pulse P=40000
3
MCX314
n Initial Speed Trailing during the S-curve Accel./ Decel. fixed pulse drive Try to adjust the volumes of parameters to have a more stable drive. R=800000 (Rate: 10), K=1000, A=D=8000, SV=100, V=2000, P=50000 Auto Decelerating Mode
R=800000 (Rate: 10), K+50, A=D=8000, SV=200, V=4000, A0=0, P=50000 Auto Decelerating Mode
www..com
4


▲Up To Search▲   

 
Price & Availability of MCX314

All Rights Reserved © IC-ON-LINE 2003 - 2022  

[Add Bookmark] [Contact Us] [Link exchange] [Privacy policy]
Mirror Sites :  [www.datasheet.hk]   [www.maxim4u.com]  [www.ic-on-line.cn] [www.ic-on-line.com] [www.ic-on-line.net] [www.alldatasheet.com.cn] [www.gdcy.com]  [www.gdcy.net]


 . . . . .
  We use cookies to deliver the best possible web experience and assist with our advertising efforts. By continuing to use this site, you consent to the use of cookies. For more information on cookies, please take a look at our Privacy Policy. X